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ABSTRACT 


"yA  multivariable  control  ayatem  for  a  deeply  submerged  submarine 
with  active  roll  control  is  designed  using  the  Linear  Quadratic 
Gaussian  with  Loop  Transfer  Recovery  (LQG/LTR)  method.  A  linear 
model  of  the  submarine  is  developed  for  a  1  degree  rudder  deflection 
at  a  speed  of  IS  knots.  The  linear  model  is  then  scaled  for  units 
and  input/output  weightings  and  augmented  with  integral  control  in 
all  four  input  channels.  Using  the  properties  of  the  linear  model^  a 
Model  Based  Compensator  (MBC)  is  designed  by  shaping  the  singular 
values  of  a  Kalman  Filter  to  meet  desired  performance  criteria  and 
then  recovering  the  singular  value  shapes  using  the  Kwaakernaak 
recovery  process.  During  extensive  testing  at  speeds  from  15  to  30 
knots,  the  compensator  performed  well  enough  so  that  gain  scheduling 
was  not  employed.  Next,  the  compensator  is  compared  to  one  designed 
for  a  30  knot  model.  Finally,  an  Anti-Reset  Windup  (ARW)  strategy  is 
employed  to  counter  the  effects  of  control  surface  saturation. 
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INTRODUCTION  AND  SUMMARY 


1 . 1  Background  and  Discussion  of  Prior  Work 

The  introduction  of  nuclear  propulsion  and  hydrodynaaically  efficient 
huilforms  on  submarines  have  resulted  in  platforms  capable  of  very  high 
submerged  speed  for  prolonged  periods  of  time.  At  these  high  speeds,  ship 
control  is  a  complex  problem  due  to  the  dynamic  forces  and  moments  acting 
on  the  submarine.  During  a  maneuvering  situation,  the  cross-flow  and 
nonsymmetric  flow  over  the  hull  may  create  a  situation  in  which  the 
submarine  can  not  be  safely  operated  using  our  present  method  of  ship 
control.  This  requires  that  speed  and  depth  restrictions  be  imposed  on  the 
employment  of  the  submarine. 

Presently,  submarine  control  systems  are  designed  by  decoupling  the 
vertical  and  horizontal  planes  of  motion,  looking  at  the  individual 
input/output  transfer  functions  and  "shaping”  the  response  as  desired. 

This  requires  the  use  of  an  oversimplified  model  of  a  very  complex  dynamic 
system.  The  recent  development  of  the  Linear-Quadratic-Gaussian  with  Loop 
Transfer  Recovery  (LQG/LTR)  methodology  has  provided  a  powerful  tool  for 
the  design  of  multivariable  control  systems.  However,  as  LQG/LTR  is 
relatively  new,  research  is  required  to  investigate  the  inherent 
limitations  of  the  methodology  and  develop  practical  applications  for  its 
use . 

Within  the  last  few  years,  several  examples  of  the  practical  use  of 


LQG/LTR  have  been  researched.  Multiple  Input  Multiple  Output  (MIMO) 


controllers  for  gas  turbine  engines  have  been  developed  Cl]  C21  C31 . 

Several  examples  of  submarine  control  systems  have  also  been  developed. 

The  submarine  controller  design  by  Harris  C4]  dealt  with  use  of  an 
inverted-Y  sternplane  configuration.  Of  particular  interest  though  are  the 
designs  of  Milliken  C5] ,  Dreher  t&l  and  Lively  C7] .  These  designs  all  used 
the  standard  cruciform  stern  configuration  presently  in  use  on  U.S. 
submarines.  Milliken' s  controller  was  sufficient  for  depth  and  course 
keeping.  Acceptable  performance  during  depth  and/or  heading  changes  was 
obtained  only  for  small  changes  over  long  periods  of  time  (i.e.  small  depth 
and  heading  rates).  Dreher  designed  two  rate  controllers.  One  controlled 
depthrate  and  heading  rate  directly  and  the  other  attempted  to  control 
these  rates  by  using  pitch  angle  and  yawrate.  In  both  cases,  acceptable 
performance  was  obtained  only  for  small  rates. 

The  design  by  Lively  provided  the  best  example  of  using  the 
Linear-Quadratic-Gaussian  with  Loop  Transfer  Recovery  (LQG/LTR)  design 
methodology  for  submarine  control.  In  an  attempt  to  capture  the 
maneuvering  dynamics  of  the  submarine,  the  linear  model  for  this  design 
used  a  diving  turn  for  a  nominal  point.  By  using  linear  compensators 
designed  at  speeds  of  5,  10,  15,  20  and  25  knots,  a  nonlinear  compensator 
was  employed  using  gain  scheduling.  This  provided  for  control  of  the 
submarine  over  the  speed  range  of  5  to  25  knots  during  speed  changes  as 
well  as  at  discrete  intermediate  speeds. 

Additionally,  Martin  E8]  has  recently  shown  the  merits  of  active  roll 
control  over  the  conventional  cruciform  configuration  for  a  submarine  at  ?Q 
knots.  By  comparing  L2G/LTR  controllers  with  and  without  differential 
sternplane  deflection  capability,  better  maneuvering  characteristics  were 
realized  especially  in  the  area  of  depthkeeping  during  turns. 


1.2  Contributions  of  the  Thesis 

The  purpose  of  this  thesis  is  twofold;  to  develop  a  practical  example 
of  the  use  of  LQG/LTR  and  to  help  open  an  avenue  for  advancenent  in  the 
area  of  submarine  ship  control  systems.  It  is  intended  that  this  thesis  be 
considered  a  feasibility  design  showing  the  promise  of  using  active  roll 
control  through  differential  deflection  of  the  sternplanes  and  not  a  final 
detailed  design  ready  for  implementation  aboard  a  submarine.  A  project  of 
that  magnitude  is  obviously  beyond  the  scope  of  this  thesis  due  to 
financial  and  time  considerations. 

In  comparison  to  the  work  of  Lively,  this  thesis  shows  that  using 
active  roll  control  through  differential  deflection  of  the  sternplanes 
eliminates  the  need  for  a  gain  scheduled  nonlinear  compensator  to  provide 
adequate  control  for  speeds  of  IS  to  30  knots.  Further  research  may  even 
permit  this  speed  range  to  be  expanded. 

To  show  the  effects  of  crossover  frequency  on  the  response  and 
stability  of  the  closed  loop  system,  a  comparison  is  made  to  the 
compensator  designed  by  Martin  C8] .  Following  this  comparison,  an 
Anti-Reset  Windup  (ARW)  feedback  loop  is  employed  to  counter  the  effects  of 
integrator  windup  during  control  surface  saturation. 


1.3  Outline  of  the  Thesis 

The  nonlinear  and  linear  models  of  the  submarine  are  discussed  in 
Chapter  2.  A  brief  description  of  the  nonlinear  equations  of  motion  used 
for  submarine  simulation  at  the  Charles  S.  Draper  Laboratory  (CSDL)  is 
presented.  This  is  followed  by  a  discussion  of  the  linearized  model 
employed  in  the  design  of  the  LQG/LTR  compensator. 


L0 


Chapter  3  contains  an  analysis  of  the  linear  model.  The  analysis 
begins  with  a  reduction  in  the  order  of  the  linear  model.  Scaling  is  then 
applied  to  provide  the  designer  with  a  more  understandable  system  of  units 
and  to  weight  the  inputs  and  outputs.  Next,  the  pole/zero  structure  and 
eigenvectors  of  the  open  loop  submarine  model  are  presented.  The  chapter 
ends  with  a  discussion  of  performance  requirements  and  specifications.  In 
this  section,  the  concept  of  singular  values  i3  introduced. 

Chapter  4  begins  with  a  discussion  of  the  Model  Based  Compensator 
(MBC)  concept  and  the  LQG/LTR  methodology.  The  design  of  the  compensator 
for  the  linear  model  is  then  presented.  The  chapter  ends  with  a 
description  of  the  compensator  and  results  of  some  of  the  maneuvering 
simulations. 

Chapter  S  begins  with  a  discussion  of  additional  maneuvering 
simulations  for  the  15  knot  compensator,  concentrating  on  more  complex 
maneuvers.  A  direct  comparison  between  the  compensator  designed  in  this 
thesis  and  that  designed  by  Martin  C83  is  also  presented  in  Chapter  5. 

A  brief  discussion  on  the  use  of  Anti-Reset  Windup  feedback  to  reduce 
the  effects  of  integrator  windup  in  the  presence  of  saturating  actuators  is 
contained  in  Chapter  6.  This  is  followed  by  implementation  of  an 
Anti -Reset  Windup  feedback  loop  in  the  15  knot  compensator  and  presentation 
of  some  results  which  demonstrate  its  effectiveness. 

Chapter  7  contains  a  summary  of  results,  conclusions  and  some 
recommendations  for  future  research. 


CHAPTER  2 


MODELING  AMD  ANALYSIS  OF  THE  SUBMARINE 


2.1  Introduction 

The  design  of  any  control  ayatea  begins  with  a  mathematical 
representation  of  the  real  world  nonlinear  system  which  we  want  to  control. 
The  model  used  for  this  thesis  was  the  analytic  version  of  the  SUBMODEL 
submarine  simulation  computer  programs  resident  on  the  computer  systems  at 
the  Charles  Stark  Draper  Laboratory  (CSDL) . 

The  chapter  begins  with  a  brief  description  of  the  nonlinear  model  and 
relevant  computer  programs.  This  is  followed  by  a  description  of  the  IS 
knot  linear  model  using  differential  deflection  of  the  sternplanes  to 
provide  the  necessary  degree  of  freedom  to  actively  control  the  roll  angle 
of  the  submarine. 


2.2  Description  of  the  Nonlinear  Submarine  Model 

Motion  of  the  submarine  is  described  in  six  degrees  of  freedom,  three 
translational  and  three  rotational.  Three  force  equations  (X,  Y  and  Z) 
define  the  translational  motions  of  surge  (axial),  sway  (lateral)  and  heave 
(normal).  The  rotational  motions  of  roll,  pitch  and  yaw  are  described  by 
three  moment  equations  (K,  M  and  N). 

The  complex  hydrodynamic  forces  and  moments  which  act  on  a  submerged 
submarine  are  best  defined  in  a  right-hand  orthogonal  coordinate  system 
fixed  in  the  body.  Figure  2.1  shows  this  coordinate  system  (and  sign 
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convention)  with  the  origin  at  the  center  of  gravity  (CG).  The  equations 
of  notion  are  more  easily  derived  in  and  control  of  the  submarine  requires 
knowledge  of  the  subaarine's  motion  (i.e.  course,  speed,  depth  and 
orientation)  with  respect  to  an  inertial  or  earth-fixed  coordinate  system. 
The  earth-fixed  system  is  also  a  right-handed  orthogonal  system,  but  is 
fixed  at  some  geographic  point  on  the  surface  of  the  water.  The 
orientation  and  motion  of  the  submarine  in  these  two  reference  frames  are 
related  by  Euler  angles  C9] ,  each  representing  a  rotation  about  a 
body-fixed  axis.  By  convention,  the  rotations  are  applied  in  the  following 
order . 

1.  (rotation  about  the  z-axis) 

2.  0  (rotation  about  the  y-axis) 

3.  0  (rotation  about  the  x-axis> 

From  the  discussion  above,  it  is  evident  that  we  are  talking  about 
nine  state  variables,  six  representing  the  translational  and  rotational 
velocities  in  the  body-fixed  reference  frame  and  three  representing  the 
orientation  of  the  body-fixed  axes  with  respect  to  earth  reference.  The 
subaarine's  depth  represents  a  tenth  state  variable.  Control  of  the 
submarine  is  accomplished  by  deflecting  the  rudder,  stern  planes,  fairwater 
planes  and/or  changing  propeller  speed. 

The  SUBMODEL  simulation  facilities  at  CSDL  are  based  on  the  ”2510 
Equations”  [10] ,  updated  with  the  cross-flow  terms  of  the  "Revised 
Equations”  [11] .  Several  additional  features  have  been  added  to  provide  a 
constant  RPS  constraint  on  the  propeller  and  a  differential  deflection 
option  for  the  sternplanes.  The  constant  RPS  constraint  reflects  the 
current  operating  policy  used  on  submarines.  The  use  of  differential 
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sternplane  deflection  provides  an  avenue  for  active  roll  control  that  is 


not  otherwise  possible.  Table  2.1  contains  a  summary  of  state  and  control 
variables. 

State  Variables 

u  3  Xi,  axial  velocity  (along  x  axis)  -  ft/sec 

v  =  X2»  lateral  velocity  (along  y  axis)  -  ft/sec 

w  =  X3,  heave  velocity  (along  z  axis)  -  ft/sec 

p  3  Xa,  roll  rate  (angular  velocity  about  x  axis)  -  rad/sec 
q  =  X5,  pitch  rate  (angular  velocity  about  y  axis)  -  rad/sec 

r  3  X&,  yaw  rate  (angular  velocity  about  z  axis)  -  rad/sec 

0  3  X7,  roll  (rotation  about  x  axis)  -  radians 

0  3  Xq»  pitch  (rotation  about  y  axis)  -  radians 

1)1  3  X9,  yaw  (rotation  about  z  axis)  -  radians 

z  3  X10,  depth  -  feet 

Control  Variables 

db  3  u]_ ,  fairwater  plane  deflection  -  radians 

dr  3  U2 ,  rudder  deflection  -  radians 

dsi  3  U3,  port  stern  plane  deflection  -  radians 

ds2  3  U4,  starboard  stern  plane  deflection  -  radians 

Table  2.1  State  and  Control  Variables 

It  should  be  noted  that  these  equations  of  motion  do  not  account  for 
actuator  dynamics.  This  will  be  addressed  further  in  the  discussion  of 
performance  requirements  in  Section  3.5.  Intuitively,  one  would  expect  the 
dynamics  of  the  submarine  to  be  independent  of  the  depth  (z>  and  the 


heading  angle  ((0) .  This  will  prove  true  as  we  will  see  in  the  next 


section. 

The  SUBMODEL  program  provides  the  following  analytic  capabilities: 

1.  Integration  of  the  nonlinear  equations  of  notion 

2.  Determination  of  a  local  equilibrium  point  in 
the  nonlinear  equations 

3.  Calculation  of  the  linearized  dynamics  about 
the  equilibrium  point 

4.  Integration  of  the  linearized  equations  of  motion 

During  integration  of  the  equations  of  motion,  the  control  surface 
deflections  nay  be  set  to  initial  values,  varied  as  a  function  of  time  or 
calculated  using  full  state  feedback  or  the  dynamic  compensation  derived 
using  the  LQG/LTR  method.  The  analytical  results  of  the  integration  may  be 
output  graphically,  in  tabular  fora  or  both.  A  full  description  of  the 
submarine  model  may  be  found  in  C123  through  CIS] . 


2.3  Description  of  the  Linear  Submarine  Model 


The  compensator  design  procedure  is  based  on  a  Linear  Time  Invariant 
(LTD  model  of  the  nonlinear  system.  The  nonlinear  equations  described  in 
Section  2.2  can  be  generally  put  in  the  fora 


x(t)  *  f t£(t) ,u(t>] 
y.<t>  »  g.Cx<t>] 

where 

x(t)  is  the  state  vector 

u(t)  la  the  control  input  vector 
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P  >  -_.L  .•  *  •  <  t  ,f»  • 


(2.1) 

(2.2) 


£(t)  is  the  output  vector 

These  equations  can  then  be  linearized  about  sone  nominal  point 
(’LoUjq)  by  using  a  Taylor  Series  expansion.  Neglecting  the  higher  order 
terms  of  the  expansion,  the  linear  dynamics  may  be  expressed  in  the  state 
space  fora 

x(t)  =  A  x(t)  ♦  B  u(t)  (2.3) 

y.<t)  =  C  x(t>  (2.4) 

where 

A  »  (^£/dx.^  |so»Sio 
B  *  (al/dti>  |xo»Ho 

C  *  riv)  j  Xn 

The  noainal  point  used  here  corresponds  to  a  local  equilibrium  point. 
This  point  is  found  by  integrating  the  nonlinear  equations  of  motion  for  a 
specific  set  of  initial  conditions.  At  their  steady-state  value,  each 
state  variable  is  then  perturbed  so  that  its  local  minimum  is  found. 

Since  the  linear  dynamics  change  with  different  noainal  points,  the 
question  arises  as  to  what  is  the  ’’correct"  noainal  or  operating  point 
about  which  to  linearize.  Selection  of  a  "benign”  noainal  point  such  as 
that  by  Milliken  t53  is  probably  satisfactory  for  an  “autopilot”  type  of 
controller.  This  controller  however,  will  be  used  for  maneuvering  as  well 
as  course  and  depth  keeping.  For  this  reason,  a  nominal  point  which 
’’captures”  the  maneuvering  dynamics  of  the  submarine  is  required.  To 
achieve  this,  the  submarine  must  be  oriented  such  that  it  experiences 
crossflow  over  the  hull  much  like  it  would  encounter  while  simultaneously 
turning  and  diving. 
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The  noainal  point  used  in  this  thesis  was  determined  using  an  initial 
forward  velocity  (surge)  of  15  knots  with  a  rudder  deflection  of  1  degree. 
This  model  is  named  S15R1  to  reflect  the  speed  and  rudder  deflection.  This 
nominal  point  was  selected  so  the  linear  model  would  have  dynamics  similar 
to  that  used  by  Martin  [8]  and  provide  a  basis  for  comparison.  The  nominal 
point  provides  sufficient  cross-coupling  between  the  horizontal  and 
vertical  planes  of  motion  to  capture  the  desired  maneuvering 
characteristics  but  is  not  too  "radical".  As  a  result,  acceptable 
performance  was  obtained  for  straight  and  level  as  well  as  maneuvering 
trajectories.  Figure  2.2  shows  the  excellent  agreement  between  the  time 
response  of  the  linear  and  nonlinear  models.  The  A  and  B  matrices  and 
values  of  the  nominal  states  may  be  found  in  Appendix  Al.  Inspection  of 
the  last  two  rows  of  these  matrices  indicate  that  our  intuition  about  the 
effect  of  z  and  l|J  on  the  other  states  was  correct.  This  will  be  of  vaiue 
when  we  consider  reducing  the  order  of  the  system. 

To  determine  the  range  of  accuracy  of  the  linear  model,  it  csn  be 
perturbed  from  its  nominal  point  by  a  set  of  initial  conditions,  integrated 
and  then  compared  to  the  nonlinear  system  for  the  same  set  of  initial 
conditions.  Figure  2.3  shows  the  results  of  the  initial  condition 
perturbation  of  20*  above  the  noainal  point.  The  perturbations  are 
summarized  in  Table  2.2. 


u  =  5.08  ft/sec 


v  =  0.150  ft/sec 
w  =  0.395E-02  ft/sec 
p  =  -.115E-04  rad/aec 
q  =  0.352E-04  rad/sec 
r  =  -.125E-02  rad/sec 
0  *  -.325  deg 
0  »  -.105  deg 

Table  2.2  20X  Perturbations  Applied  to  S15R1 


2.4  Selection  of  the  Output  Variables 

Several  factors  auat  be  considered  in  the  selection  of  the  output 
variables.  First  and  forenost  is  the  intent  of  the  controller  and  the 
inherent  capabilities  of  the  system  to  be  controlled.  For  example,  an 
attempt  to  control  roll  angle  without  using  differential  sternplane 
deflection  cannot  possibly  succeed. 

Next,  a  constraint  of  the  methodology  is  that  the  dimension  of  the 
output  vector  must  equal  the  dimension  of  the  control  input  vector  C 161 . 
Since  there  are  four  control  inputs  <db,  dr,  dsl,  ds2),  there  must  be  four 
syatem  outputs. 

Finally,  the  effect  of  each  control  input  "felt"  at  the  output  must  be 
considered.  Two  states  may  have  influence  on  the  results  the  designer  is 
trying  to  affect.  The  state  which  requires  the  least  control  surface 
deflection  to  achieve  the  desired  results  is  the  better  one  to  use  since  it 
will  require  less  energy,  result  in  lower  compensator  gains  and  reduce  the 
chance  of  saturating  the  inputs. 
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A  submarine  is  presently  maneuvered  by  deflecting  the  central  surfaces 
until  a  particular  turning  rate,  depth  rate  or  attitude  is  achieved. 

Knowing  the  handling  characteristics  of  the  submarine,  the  operators 
maintain  the  rates  until  a  predetermined  point  when  the  surfaces  are 
deflected  to  counteract  the  rates  which  have  developed.  If  done  correctly, 
the  submarine  will  "meet”  the  desired  course  and/or  depth  with  little  or  no 
overshoot.  For  this  reason,  the  yaw  rate  and  depth  rare  z  will  be  used 
as  output  variables. 

The  attitude  of  the  submarine  in  pitch  and  roll  strongly  affects  its 
performance.  As  the  pitch  angle  becomes  excessive,  it  becomes  increasingly 
difficult  to  maintain  depth  or  control  depth  rate  because  the  fairwater 
planes  saturate.  As  roll  angle  increases,  the  forces  generated  by  the 
control  surfaces  act  out  of  the  plane  they  were  meant  to.  To  visualize 
this  problem  imagine  the  submarine  rolling  80°.  At  this  point,  the  rudder 
will  act  as  a  sternplane  and  the  sternplanes  as  rudders.  Additionally,  the 
force  and  moment  generated  by  crossflow  over  the  sail  is  quite  significant 
and  contributes  to  roll  and  pitch.  These  illustrations  show  the  importance 
of  roll  0  and  pitch  0. 

For  this  thesis  then,  the  output  vector  y.(t>  is  given  by 
£<t)  =  C0(t)  0<t>  $(t)  z<t)]T  (2.5) 

where 

lf/( t)  =  -u»ain0  *  v*cos0»sin0  ♦  w*cos0»cos0  (2.6) 
z(t>  =  (r*cos0  ♦  q»sin0)/cos8  (2.7) 

The  linearized  equations  for  ^  and  z  are  easily  derived  from  the  state 
space  equation  (2.3).  The  elements  of  the  C  matrix  which  represent  <jf  and  z 
are  simply  the  last  2  rows  of  the  A  matrix. 


CHAPTER  3 


LINEAR  MODEL  ANALYSIS 


3.1  Introduction 


This  chapter  begins  with  a  reduction  of  the  tenth-order  aodel  and 
discussion  of  the  scaling.  Next,  the  eigenatructure  and  pole/zero 
structure  of  the  reduced  aodel  will  be  presented.  Finally,  system 
perforaance  in  the  area  of  steady  state  error  and  crossover  frequency  will 
be  discussed.  In  the  section  on  perforaance,  the  concept  of  singular 
values  and  their  use  will  be  introduced.  The  reader  already  faailiar  with 
the  concept  and  its  application  to  NINO  control  systea  design  aay  wish  to 
skip  to  the  last  paragraph  of  that  section  for  a  summary  of  the  perforaance 
specifications  applicable  to  this  design. 


3.2  Reduction  of  the  Nodal 

As  noted  in  Section  2.3,  the  depth  and  heading  angle  (yaw)  have  no 
effect  on  the  dynaaic  response  of  the  other  eight  states.  This  aay  be 
verified  by  inspection  of  the  last  two  columns  of  the  A  matrix  in  Appendix 
Al.  Had  the  assuaption  of  a  deeply  submerged  submarine  not  been  made,  one 
would  expect  depth  and  heading  to  have  a  significant  effect  on  the  states 
due  to  near-surface  suction  forces  and  direction  of  the  seas. 

Additionally,  inspection  of  the  last  four  rows  of  the  B  matrix  reveals  that 
the  control  surfaces  have  no  direct  effect  on  If/,  6,  0  or  z. 
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Since  this  controller  does  not  use  tj)  or  z  as  outputs  and  the  other 
states  are  not  functions  of  these  variables,  they  aay  be  deleted  from  the 
aodel.  This  is  accomplished  by  deleting  the  last  two  columns  ox  the  A 
matrix  and  the  last  two  rows  of  the  A  and  B  matrices.  As  we  will  see  in 
Chapter  4,  this  will  also  reduce  the  order  of  the  compensator  state  vector 


3.3  Scaling 

The  use  of  scaling  has  been  employed  to  change  the  state  and  control 
variables  of  the  linear  system  into  units  which  are  more  easily  understood 
and  to  provide  weighting  on  the  inputs  and  outputs  of  the  system.  Kappos 
C2]  and  Boettcher  C171  have  addressed  scaling  and  its  effects.  Obviously, 
the  singular  values  of  the  system  will  be  changed  but  the  effect  on  system 
robustness  is  not  fully  understood. 

To  provide  the  designer  with  a  more  easily  understood  system  of  units 
rotational  or  angular  variables  are  expressed  in  units  of  degrees  and 
degrees  per  second  vice  radians  and  radians  per  second.  Translational 
variables  remain  in  units  of  feet  and  feet  per  second. 

The  unsealed  state  space  system  as  expressed  in  equations  (2.3)  and 
(2.4)  is  scaled  by  defining  new  state,  control  and  output  vectors  where 

x '  =  S*  x 

u'  1  Sjj  u 

y/  =  Sy  y  (3.1) 

The  scaling  matrices  S*,  Sjj  and  Sy  are  diagonal  matrices  whose  elements 
provide  the  desired  transformation  of  units.  Consequently,  the  system 


matrices  (scaled  for  units)  become 


A'  =  Sy  A  Lx*1 

S'  »  Sx  B  Lr1 

C '  =  Sy  C  S**1  (3.2) 


Details  of  the  unit  transformation  scaling  aatnces  and  scaled  systea 
Matrices  aay  be  found  in  Appendix  A2. 

Now  that  the  systea  has  been  scaled  for  units,  we  must  consider 
scaling  the  outputs  and  inputs  to  reflect  their  relative  importance.  These 
weights  were  selected  to  coincide  with  those  for  a  coapensator  being 
concurrently  developed  by  Martin  181 .  Weights  were  selected  for  the 
outputs  such  that  yaw  rate  and  depth  rate  were  aore  iaportant  than  roll  and 
pitch  and  are  given  by 
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Input  weights  were  selected  by  comparing  the  naxiaua  deflection  of  each 
control  surface.  Rate  and  deflection  limits  are  listed  in  Table  3.1. 


Control 

db 

dr 

dsi,dS2 


Rate  Limit 
7  deg/sec 
4  deg /sec 
7  deg/sec 


Deflection  Limit 
20  degrees 
♦.  30  degrees 
♦,  25  degrees 


Table  3.1  Control  Surface  Rate  and  Deflection  Limits 


For  this  thesis,  the  control  surface  dynamics  (deflection  rates)  will  be 
treated  as  high  frequency  modeling  error.  Considering  the  deflection 
limits  above,  the  selected  input  scaling  is  given  by 
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Figure  3.1  Block  Diagram  Representation  After  Scaling 
The  effect  of  scaling  on  the  plant  transfer  function  matrix  is  given  by 
G'(s)  =  |y  Sy  G(s)  Sy-1  §u_1  (3.3) 


where  G(s)  ia  the  plant  transfer  function  matrix  prior  to  any  scaling.  The 
input  and  output  scaling  aa  well  as  the  unit  transformation  is  identical  to 
that  used  by  Martin  C8]  so  that  a  better  comparison  of  the  two  compensators 
may  be  made  (presented  in  Chapter  5).  A  summary  of  the  plant 
matrices  after  scaling  can  be  found  in  Appendix  A3. 


3.4  Elaenstructure 


To  examine  the  modes  of  the  state  space  system  defined  by  (2.3)  and 
(2.4),  the  linear  transformation  (3.4)  is  applied  to  the  state  vector  where 


the  matrix  P  is  the  constant  ana  nonsmgular  matrix  of  eigenvectors  Pj_i 
through  Pni  as  defined  in  (3.5).  The  new  state  space  (3.6)  representation 

li!  I 

E  =  Eli  !  S2i  |  E3i| . {  Eni 

III  I 

2(t)  =  P-1  A  P  2(t)  ♦  P-1  B  u(t) 

£(t)  *  C  T  2 ( t )  (3.6) 

consists  of  n  decoupled  equations  describing  the  modal  response  of  the 
system.  The  matrix  P~1  A  P  is  a  diagonal  matrix  whose  elements  are  the 
eigenvalues  of  the  state  space.  Each  eigenvector  describes  the  motion  of 
its  associated  submarine  mode  along  the  coordinate  axes  of  the 
8-dimensional  A  matrix.  Since  the  dynamic  response  of  the  submarine  is  a 
linear  combination  of  these  modal  responses,  useful  information  may  be 
obtained  by  analy2ing  the  contribution  of  each  state  to  a  particular  node. 

Figure  3.2  shows  the  state  breakdown  of  each  normalized  eigenvector 
and  its  associated  eigenvalue  in  bar  chart  fora.  The  vertical  scale  of  0.0 
to  1.0  has  been  selected  to  reflect  the  percent  contribution  of  each  state 
to  the  overall  magnitude  of  the  eigenvector.  Due  to  the  difference  in 
variables  and  units  (translational  and  rotational),  cross-coupling  between 
terms  and  the  complex  nature  of  the  dynamics  involved,  a  clear  cut  physical 
explanation  of  all  the  modes  is  not  always  possible.  Several  modes  do 
however  exhibit  clear  physical  meaning  leading  to  the  following 
interpretation . 

(1)  Modes  1  and  2  are  a  complex  conjugate  pair  representing 
the  oscillatory  nature  of  pitch. 


(2)  Mode  3  is  heavily  dependent  on  forward  speed  and  is 
therefore  most  likely  related  to  drag. 

(3)  Modes  5  and  6  are  a  coaplex  conjugate  pair  representing 
the  oscillatory  nature  of  roll. 

(4)  The  submarine  is  open  loop  stable  since  all  poles  are 
in  the  left  half  plane  (LHP). 

The  eigenvalues,  eigenvectors  (modal  matrix)  and  transmission  zeros  for  the 
linear  model  are  presented  in  Appendix  Bl. 

System  stabilizablility  (unstable  modes  are  controllable)  and 
detectability  (unstable  modes  are  observable)  can  also  be  addressed  by 
simple  inspection  of  the  T~1  B  and  C  T  matrices  in  Appendix  B2.  The 
elements  of  these  matrices  represent  the  link  between  the  original  state 
apace  system  and  the  decoupled  system  and  a  zero  element  in  one  of  these 
matrices  would  indicate  a  that  the  link  is  not  present.  The  breakdown  of 
the  controllability  matrix  in  Figure  3.3  shows  the  relative  impact  of  the 
control  inputs  on  each  mode.  Similarly,  the  observability  matrix 
represents  the  relative  contribution  of  each  mode  to  the  system  output 
variables.  When  used  in  conjunction  with  the  eigenvector  breakdown, 
additional  physical  information  can  be  gained  about  the  system  dynamics. 

Inspection  of  Figure  3.3  reveals  that  Modes  1  and  2  which  represent 
pitch  of  the  submarine  are  mostly  affected  by  the  fairwater  planes  and 
sternplanes.  The  dominance  of  Mode  3  by  rudder  deflections  explains  the 
reason  for  the  large  dependence  of  Mode  3  on  forward  velocity.  All  control 
surface  deflections  cause  a  loss  in  forward  speed  due  to  added  drag.  The 
rudder,  being  the  largest  control  surface,  has  significant  effect  even  for 
small  deflections.  Mode  4  which  has  no  real  dominant  state  is  also  most 
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affected  by  rudder  deflection.  Since  roll  angle  is  a  major  contributor  to 
this  aode  followed  cioseiy  by  forward  speed,  this  probably  represents  the 
speed  loss  and  roll  angle  induced  by  the  crossflow  over  the  sail  of  a 
turning  subnarine.  Modes  5  and  6  which  represent  the  roll  characteristics 
of  the  submarine  are  dominated  by  the  sternplanes  with  a  smaller 
contribution  from  the  rudder.  Obviously,  the  differential  deflection  of 
the  sternplanes  will  affect  roll.  The  effect  of  the  rudder  on  roll  has 
already  been  mentioned.  Mode  7  which  is  dominated  by  pitch  with  lesser 
contributions  from  pitch-related  states  is  mostly  controlled  by  the 
fairwater  planes.  No  clear  interpretation  of  the  rudder  deflections  which 
control  Mode  8  is  possible. 

To  provide  an  indication  of  the  coupling  between  control  inputs  and 
output  variables,  a  singular  value  decomposition  of  the  plant  transfer 
function  G(s)  is  presented.  Details  of  the  theory  behind  singular  value 
decomposition  may  be  found  in  Athans  CIS]  and  Lehtomaki  CIS] .  The  plant 
transfer  function  matrix  is  given  by 


G(s)  =  C  (si  -  A)-l  B  =  U  E  VH 


where 


U  is  the  matrix  of  left  singular  vectors 
E  is  a  diagonal  matrix  of  the  singular  values 
VH  is  the  matrix  of  right  singular  vectors 


and  at  s  =  0  by 


G<0)  =  C  (-A)-l  B 


Therefore,  since 


we  can  define 


y.(t)  =  G(0)  u(t)  =  U  E  V H  u(t) 


y/  Ct)  =  E  u ' (t) 


where 


y/(t)  =  U"1  y.<t> 
u'(t)  =  V.H  u<t) 

Since  £  is  a  diagonal  matrix,  a  direct  coaparison  of  the  left  and  right 
singular  vectors  for  each  singular  value  will  yield  the  desired  information 
about  input/output  coupling.  The  left  and  right  singular  vectors  for  each 
singular  value  are  presented  in  Figure  3.4.  For  we  see  that 

deflection  of  the  aternplanes  results  in  the  coupled  response  in  pitch 
angle  and  depthrate.  Intuitively,  one  would  think  that  sternplanes  would 
affect  pitch  aore  that  depthrate.  One  explanation  is  that  these  variables 
are  strongly  coupled  but  have  different  units.  As  is  obvious  from  <322 » 
deflection  of  the  rudder  affects  priaarily  z  but  does  exhibit  soae  effect 
on  roll  angle.  This  is  a  reflection  of  the  effect  of  rudder  aoveaent  and 
should  not  be  interpreted  as  a  feasible  way  to  control  roll  angle.  The 
effect  of  differential  deflection  of  the  sternplanes  is  exhibited  by  033. 

As  shown  by  0*44,  deflection  of  the  fairwater  planes  affects  priaarily  pitch 
and  depthrate  to  a  somewhat  lesser  extent.  Again,  the  difference  in 
variables  and  coupling  between  pitch  and  depthrate  is  the  probable  reason 


for  this  behavior. 
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Figure  3.4  Singular  Value  DeconpoalUon  of  S15R1 


3.5  Performance  Soecif ications 


The  performance  requirements  used  in  this  thesis  represent  the 
choices  of  the  designer  and  may  not  necessarily  meet  any  established 
criteria  set  by  legal  authority.  The  specifications  here  will  deal  with 
steady-state  error,  disturbance  rejection  and  stability  robustness.  First, 
the  concept  of  singular  values  will  be  briefly  discussed. 

A  logical  extension  of  the  Bode  plot  can  be  made  from  the  SISO  case  to 
the  MIMO  system  by  consideration  of  the  singular  values  of  the  system.  The 
singular  values  of  a  complex  matrix  M  are  defined  by 


<Ti  f  W)  = 


(3.4) 


where 

cri  is  the  ith  singular  value  of  K 

«H  is  the  coaplex  conjugate  transpose  of  H 

Ai  is  the  ith  eigenvalue  of  [MHM3 


Referring  to  (3.4),  a  matrix  M  is  considered  “large”  when  its  minimum 
singular  value  is  large  and  "small"  when  its  maximum  singular  value  is 
small.  Using  these  definitions,  we  can  now  address  command  following, 
disturbance  rejection,  reduction  in  sensitivity  to  modeling  errors  and 
response  to  sensor  noise. 

Our  ultimate  goal  is  to  design  a  robust,  dynamic  compensator,  X(s)  to 
control  the  Linear  Time  Invariant  (LTI)  plant,  Gp(s).  Figure  3.5  shows  the 
feedback  loop  structure  with  unity  negative  feedback,  command  input  r(s), 
plant  input  u(a),  system  output  y.(a),  output  disturbance  vector  d(s)  and 
measurement  noise  n(s).  From  Figure  3.5,  the  following  frequency  domain 
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relation  can  be  easily  derived 

y.(s>  =  Cl  ♦  G(s)K(a>3-lG(a>K(a>  r(s) 

♦  Cl  *  G(s)K(s)l*l  d(a) 

Cl  ♦  G(s)KCs)]  "1  n(a>  (3.5) 

Free  (3.5),  we  see  that  to  have  "good"  command  following  and 
disturbance  rejection,  the  Loop  Transfer  Matrix  G(s)K(a)  and  therefore 
(TainCG(s)K(s) )  must  be  "large"  in  the  frequency  range  of  the  reference 
commands.  To  reduce  the  sensitivity  to  modeling  errors,  (rmax(G(s)K(s) ) 
must  be  "small"  in  the  frequency  range  of  the  modeling  errors.  Similarly, 
for  "good"  noise  rejection,  <Tsax £&(s) K(s) )  must  be  “small"  in  the  frequency 
range  of  the  noise.  Figure  3.6  shows  the  Bode-like  plot  interpretation  of 
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tneae  singular  value  requirements.  More  detail  on  thi3  subject  say  be 
found  in  Athana  C 161 . 

With  respect  to  conaand  following,  it  is  desired  to  have  zero  steady 
3tate  error  to  step  inputs.  This  coincides  with  the  singular  value 
requireaent  discussed  above.  As  such,  integrators  were  placed  in  all  four 
input  channels.  Figure  3.7  shows  the  new  plant  configuration  where  the 


! - | 


state  space  representation  of  the  augaentation  is  defined  by 

Ga<s)  =  (£/s)  (3.6) 

and  the  resultant  plant  transfer  function  aatrix  is 

G(s)  =  Gp(s)Ga (a)  (3.7) 

The  augmented  plant  is  now  a  12-diaenaional  system,  however  the  4 
integrator  states  are  included  as  part  of  the  plant  only  during  the  L3G/LTR 
compensator  design.  During  iapleaentation,  the  integrators  become  part  of 
the  compensator.  The  singular  values  of  the  original  plant  Gp(s)  and  the 
augmented  plant  G(s)  are  shown  in  Figures  3.8  and  3.9  respectively.  Note 
that  augmenting  the  plant  has  increased  the  singular  values  at  .001 
radians/second  by  approximately  60  db.  The  matrices  of  the  augmented  plant 
may  be  found  in  Appendix  A3. 


The  next  area  which  needs  to  be  addressed  is  crossover  frequency.  As 
crossover  frequency  is  increased,  the  system  responds  faster  and  one  would 
expect  better  performance.  At  slower  speeds  however,  the  control  surfaces 
have  less  effect  for  a  given  deflection  since  the  forces  and  Moments 
generated  are  proportional  to  speed  squared.  Since  this  coepensator  will 
be  compared  to  the  one  being  concurrently  developed  by  Martin  C8] ,  a 
comparable  crossover  frequency  is  desired.  To  avoid  frequent  control 
surface  saturation  and  in  some  cases  limit  cycling  due  to  the  decrease  in 
effectiveness,  a  compromise  must  be  reached.  Additionally,  actuator 
dynamics  which  exist  at  approximately  2  to  3  radians/second  [53  C6] ,  have 
not  been  included  in  this  model  and  must  be  treated  as  modeling  error.  For 
this  thesis,  a  crossover  frequency  of  0.1  radian  per  second  was  found  to  be 
suitable. 

Finally,  a  brief  discussion  of  robustness  is  in  order.  According  to 
Lehtoaaki  (181,  the  error  §,<*)  between  the  real  system  ^(s)  and  the  linear 
model  G(a)  can  provide  a  measure  of  stability  robustness.  These  errors  are 
characterized  as  additive,  subtractive,  multiplicative  or  division  in 
nature.  In  particular,  the  multiplicative  and  additive  errors  can  be  used 
to  provide  a  measure  of  the  relative  and  absolute  errors,  respectively.  A 
block  diagram  representation  of  multiplicative  error  as  defined  by  (3.8)  is 
shown  in  Figure  3.10.  Additive  error  is  defined  by  (3.9).  Using  these 


<3.a> 


G(s>  =  Cl  ♦  E (3) ]  G  (s)  =  L(s)G(s) 

E(s)  =  CG(s)  -  G  (s>  1  G(s)*l 

£<s)  *  E(s)  ♦  G (3) 

E  ( s )  =  £(s)  -  G(s)  (3.9) 

relationships,  it  can  be  shown  that  if  the  singular  value  inequalities 
(3.10)  and  (3.11)  hold,  we  are  guaranteed  a  closed  loop  stable  system. 

tfsaxtkts)  -  I)  <  ♦  CG(s)K(s> ) -1)  (3.10) 

-I)  <  ♦  G(s)K(s) }  (3.11) 

The  aodeling  errors  say  be  difficult  to  quantify  but  looking  at  it  from 
another  aspect,  if  we  calculate  the  right  hand  side  of  the  inequalities, 
then  the  maximum  tolerable  error  is  known.  These  relationships  provide 
conservative  stability  bounds  so  that  a  closed  loop  syates  may  still  be 
stable  if  the  bounds  are  crossed.  System  stability  would  then  have  to  be 
determined  through  extensive  testing  and  evaluation.  Additional 
information  on  stability  robustness  may  be  found  in  C19)  through  C221 . 
Performance  specifications  may  therefore  be  quickly  summarized  as 

(1)  The  singular  value  requirements  in  Figure  3.6  must 
be  met 

(2)  Integrators  in  all  input  channels  will  insure  zero 
steady-state  error  to  step  inputs 

(3)  Maximum  crossover  frequency  is  0.1  radian/second 
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3.6  Sunnarv 


In  Chapter  3,  the  order  of  the  iinear  model  haa  been  reduced  by  2 
3tates  and  scaled  for  units  and  Input/output  weightings.  The  poie/zero 
structure  and  eigenvectors  have  been  presented.  In  the  section  on  modal 
analysis,  the  relative  contribution  of  the  states  to  each  node  was 
considered  and  the  issues  of  stabilizability  and  detectability  were 
addressed.  The  coupling  between  inputs  and  outputs  was  also  presented. 
Finally,  the  performance  specifications  in  terms  of  singular  value 
requirements  and  crossover  frequency  were  detailed.  In  Chapter  4,  the 
LQG/LTR  methodology  and  a  summary  of  the  compensator  design  are  presented 


CHAPTER  4 


LINEAR  COMPENSATOR  DESIGN 


4. i  Introduction 


This  chapter  covers  the  design  of  linear  compensator  for  the  S15R1 
modei  discussed  in  Chapters  2  and  3.  It  begins  with  a  general  discussion 
of  the  Model  Based  Compensator  (MBC)  concept  and  the  Linear  Quadratic 
Gaussian  with  Loop  Transfer  Recovery  (LQG/LTR)  aethodology  tailored  for 
performance  and  robustness  at  the  plant  output.  This  is  followed  by  a 
summary  of  the  linear  compensator  design  for  the  S15R1  model.  Finally,  the 
results  of  several  simulations  with  the  compensator  integrated  in  the 
nonlinear  analytic  model  at  CSDL  are  presented.  The  compensator  is  further 
analyzed  and  critiqued  in  Chapter  5  where  it  is  compared  to  the  530R1 
compensator  designed  by  Martin  183 . 


4.2  The  LQG/LTR  Design  Methodology 

Figure  4.1  again  shows  the  feedback  loop  structure  with  unity  negative 
feedback.  Note  that  the  original  plant  Gp(s)  has  been  replaced  with  the 
augmented  plant  G(s)  as  defined  by  (3.7).  The  compensator  K(s)  must 
provide  closed  loop  performance  commensurate  with  the  criteria  noted  in 
Chapter  3.  This  will  be  accomplished  through  the  design  of  a  Model  Based 
Compensator  (MBC)  (163  using  the  Linear  Quadratic  Gaussian  with  Loop 
Transfer  Recovery  (LQG/LTR)  aethodology  (233  through  (253 . 
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rigurs  4.1  Feedback  Loop  Structure  with  G(s) 

The  L3G/LTR  methodology  guarantees  the  designer  a  MI MO  compensator 
X(s)  that  is  closed  loop  stable  while  providing  the  necessary  degrees  of 
freedom  for  ‘‘loop  shaping'*  (shaping  of  the  singular  values  of  G(s)K(s))  to 
achieve  desired  performance  while  maintaining  stability  robustness.  Figure 
4.2  shows  the  structure  of  the  feedback  loop  using  the  MBC.  The  state 
vector  of  the  MBC  is  z(t)ERn  (i.e.  the  same  dimension  as  x(t),  the  plant 
state  vector),  hence  we  ultimately  wind  up  with  an  open  loop  system 
G(s) K(s)  which  is  2n-dimensional .  The  reduction  of  the  model  described  in 
Section  3.2  has  therefore  reduced  the  resultant  closed  loop  system  by  a 
total  of  4  states. 

The  MBC  derives  its  name  from  the  fact  that  the  A,  B  and  C  matrices 
defined  in  the  state-space  representation  of  the  plant  appear  in 
the  dynamics  of  the  compensator.  The  open-loop  plant  dynamics  are 

x(t)  *  A  x(t)  *  B  u(t)  (4.  1) 

y.(t)  =  C  x ( t )  (4.2) 

where  x(t)ERn,  u(t)£R*  and  y.(t)ER®.  Note  that  u(t)  and  y.(t)  are  the  same 
dimension  as  constrained  by  the  methodology.  The  frequency  domain 
representation  for  the  plant  transfer  function  S.(s)  is  given  by 


Dynamics  of  the  MBC  in  the  tine  domain  are 


Z(t)  =  CA  -  B  G  -  H  C3  Z(t)  -  H  e(t)  (4.4) 

u(t)  =  -G  z(t)  (4.5) 

and  the  compensator  transfer  function  K(s)  i3 

K(s)  =  G  (si  -  A  ♦  B  G  ♦  H  CJ'l  H  (4.6) 

where  the  Filter  Gain  Matrix  H  and  Control  Gain  Matrix  G  are  design 
parameters  for  the  compensator. 

As  derived  in  C163 ,  by  defining  a  state  estimation  vector  (4.7),  the 
dynamics  of  the  closed  loop  system  can  be  represented  by  (4.8). 


w(t)  =  x ( t )  -  z(t) 


(4.7) 


x(t) 

w(t) 


(A  -  B  G)  -3  G 

x(t) 

0 

♦ 

0  (A  -  HZ) 

w(t) 

-H 

(4.8) 


By  examining  the  closed  loop  A  matrix  above,  it  is  evident  that  the  root3 
of  (4.9)  yield  the  2n  eigenvalues  of  the  closed  loop  system  and  for  closed 
loop  stability,  (4.10)  and  (4.11)  must  hold. 


detlsl  -  A  ♦  B  G 3  •  det Cal.  -  A  ♦  H  C3  =0  (4.9) 

RefXiCA  -  B  G 3 )  <  0  ;  i=l,2 . n  (4.10) 

ReOjCA  -  H  C 3  J  <  0  ;  i=l,2 . n  (4.11) 


It  now  becomes  clear  that  the  compensator  design  decomposes  into 
finding  G  and  H  such  that  (4.10)  and  (4.11)  hold.  The  Linear  Quadratic 
Gaussian  (LQG)  methodology  provides  the  necessary  tools  to  make 


"intelligent."  choices  for  the  compensator  gam  matrices  thus  the  L3G 
controller  is  a  special  type  of  Model  Based  Compensator.  A  review  of 
equations  (4.4)  and  (4.5)  reveai  the  LSG  controller  to  be  a  cascaded 
combination  of  a  Kaiaan-Bucy  Filter  and  a  full-state  feedback  Linear 
Quadratic  Regulator. 

Selection  of  the  Filter  Gam  Matrix  H  is  made  through  the  solution  o 
a  Kalaan-Bucy  Filter  (KBF)  problem  based  on  equation  (4.4).  The  Filter 
Gain  Matrix  is  defined  by 

H  =  (1/jj)  E  CT  (4.12) 

where  E  =  Ej  >.  0  is  the  unique  solution  of  the  Filter  Algebraic  Riccati 
Equation  (FARE) 

0  =  i  E  ♦  E  At  ♦  L  Lt  -  (1/p)  E  CT  C  E  (4.13) 

subject  to  the  constraints 

»  CA,C]  detectable 

•  CA,L)  stabilirable 

•  p  >  0 

The  Control  Gain  Matrix  G  is  defined  by  (4.14)  as  determined  through 
the  solution  of  the  "cheap"  LQR  (Linear  Quadratic  Regulator)  control 
problem 

u(t)  =  -G  z(t)  =  -R-l  BT  K  (4.14) 

where  K  =  Xj  >  0  is  the  unique  solution  of  the  Control  Algebraic  Riccati 


Ecuation  (CARE) 


sub3ecn  to  the  constraints 


*  CA,BI  stabilizabie 

*  CA, Cl  detectable 

*  E.  »  I 

»  q  >  0 

The  compensator  gains  could  now  be  determined  if  the  design  parameters 
q,  u  and  L  were  known.  To  determine  the  "correct"  values  for  these  design 
paraaeters,  we  now  turn  our  attention  to  Loop  Transfer  Recovery  (LTR) . 

Refering  to  Figure  4.2,  performance  and  stability  robustness  can  be 
measured  at  the  plant  input  or  plant  output  by  breaking  the  loop  at  the 
corresponding  point.  For  the  design  of  the  submarine  controller,  physical 
significance  at  the  plant  output  has  been  retained  (point  (2) on  Figure  4.2) 
and  therefore  the  latter  approach  will  be  used.  The  reader  is  referred  to 
C23]  and  C241  for  an  explanation  of  the  methodology  with  respect  to 
performance  and  robustness  at  the  plant  input. 

The  design  of  the  controller  can  now  be  performed  in  the  following 
fashion. 

(1)  Design  a  Kalman  Filter  with  appropriate  singular  values 
using  the  KBF  equations  (4.12)  and  (4.13) 

(2)  Recover  the  singular  value  shapes  using  the  LQR  equations 
(4.14)  and  (4.15) 

The  following  definitions  of  the  filter  open  loop  and  Kalman  Filter 
transfer  functions  are  useful  in  the  development  of  the  design  procedure 

Gfol(3>  a  C  (si  -  A)*l  L  (4.16) 

G>f(s)  *  C  (si  -  A)'l  H  (4.17) 
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Note  that  <4.17)  represents  the  loop  transfer  function  when  the  L.GG 
loop  in  Figure  4.2  is  broken  at  point  Q  .  The  relationship  between  these 
transfer  functions  is  given  by  the  following  Return  Difference  Identity 
<4.18)  also  known  as  the  Kalman  Frequency  Domain  Equality  (FDE)  for  the 
filter. 

<s)  ]  CI+Gitf  <s) )  H  =  L  ♦  <l//i)Gfol  <s)  <4.18) 

By  looking  at  the  singular  values  of  both  aides  of  the  FDE  <4.19),  the 
approximation  <4. 20)  holds  for  <TiCGi<f<s)}  >>  1,  i.e.  at  low  frequency. 

CTi  C I.  ♦  Gkf<s))  =  /l  ♦  <i/^)(Ti2cGf0i<s) )'  <4.19) 

tri{G]cf<s)}  =  <Ti(<l/yjI)Gfol(s>)  <4.20) 

This  means  the  singular  values  of  the  KBF  can  be  "shaped"  to  meet  the 
desired  performance,  crossover  and  robustness  requirements  by  selecting 

1.  L  for  the  desired  loop  shape 

2.  }i  for  the  desired  crossover  frequency 

Using  the  value  of  and  the  matrix  L  from  above,  H  is  calculated 
using  the  KBF  equations  and  the  following  properties  are  guaranteed. 

•  Closed-loop  stability  <for  the  filter) 

•  -6db  <  Gain  Margin  <  oo 

•  -60°  <  Phase  Margin  <  60° 

Now  that  the  Filter  Gain  Matrix  has  been  determined,  the  zeros  of  the 
plant  tranfer  function  G<a)  are  checked.  If  the  plant  is  minimum  phase,  we 
are  guaranteed  recovery  of  the  "nice"  shape  and  properties  of  the  Kalman 
Filter  using  the  Kwakernaak  "sensitivity  recovery"  C26J  via  the  L3R 


equations.  At  this  tine,  the  effects  of  non-minimum  phase  (NX?)  zeros  are 
not  clearly  understood,  but  suffice  it  to  say  that  some  degradation  m  the 
recovery  process  and  resulting  closed  loop  performance  is  certain  if  one  or 
■tore  NMP  zeros  are  within  the  bandwidth  of  the  controller.  If  the  plant  is 
non-minimum  phase,  ali  that  can  presently  be  done  is  to  proceed  and  use 
extensive  testing  and  evaluation  to  detect  instabilities  or  other  problems. 

The  LQR  equations  are  now  solved  (as  q— ►oo)  to  determine  the  Control 
Gain  Matrix  G.  Using  the  G  and  H  matrices,  the  LQG  compensator  matrix  K(s> 
is  determined  using  (4.6).  The  singular  values  of  G(s)K(s)  are  then 
compared  to  the  singular  values  of  Gj<f(s).  If  the  ffi  (G(3)i((s) )  are 
sufficiently  different  from  dl  (Gj<f (s) 1 ,  q  must  be  increased  and  the  LQR 
equations  solved  for  a  new  Control  Gain  Matrix.  Recovery  of  the  Kalman 
Filter  loop  shape  is  considered  satisfactory  when  there  is  good  agreement 
for  at  least  1  decade  past  crossover.  At  that  point,  the  rolloff  of  the 
singular  values  is  at  least  -40  db/decade  (two  pole  rolloff) .  The  Loop 
Transfer  Matrix  G(s)K(s)  is  then  checked  for  robustness  as  discussed  in 
Section  3.5. 


4.3  Design  of  the  LQG/LTR  Compensator  for  the  S15R1  Model 

As  discussed  in  the  previous  section,  the  design  of  the  compensator  is 
performed  as  follows. 

(1)  Design  a  Kalman  Filter  loop  with  appropriate  singular 
value  shapes 

(2)  Attempt  to  recover  these  singular  value  shapes  using 


the  Kwaakernaak  recovery  method 


The  reader  is  once  again  reminded  that  during  the  LQG/L7R  design  process, 
the  plant  matrices  which  are  used  are  that  for  the  augmented  scaled  plant 
G(s).  Any  augmentation  is  separated  from  the  plant  model  and  included  in 
the  compensator  prior  to  implementation  for  testing. 

Design  of  the  Kalman  Filter  loop  hinges  on  selection  of  the  parameter 
)i  (magnitude  of  the  measurement  noise  intensity)  and  the  matrix  L  so  that 
the  singular  values  of  Gf0i(s>  as  defined  by  (4.16),  have  a  “nice"  shape 
like  that  shown  in  Figure  3.5  and  meet  the  performance  specifications  set 
in  Section  3.5.  To  enhance  chances  of  a  good  recovery  of  these  shapes  in 
the  LQR  loop,  it  is  desired  to  have  the  minimum  and  maximum  singular  values 
match.  This  i.«  accomplished  by  selecting  L  such  that  the  singular  values 
match  at  high  and  low  frequencies. 

The  augmented  plant  transfer  function  G(a)  =  Ga(s)Gp(s)  is  defined  by 


G(s)  *  C  (si  -  A)*1  B 


(4.21) 


where 


A  = 


0  0 
Bp  Cp 


C  =  [o  Cp] 


and  therefore 


[.i-  *] 


si  o 

-Bp  (si.  -  Ap) 


(4.22) 


Looking  at  (4.22)  at  low  frequency,  (si.  -  Ap)  — -Ap  and  a  good 
approximation  for  (si.  -  A)*1  is 


(si  -A)*1  » 


(1/S)I  0 

-(l/5) Ap'^Bp  -Ap*1 


(4.23) 


provided  Ap*1  exists.  Therefore  by  (4.16),  Sfol(a>  i3  approximately 
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Gfol <s) 


s 


J..,  I,  I,.  I' .  '  m 


|_  o  c?  J 


>i  o 

-(l/a)Ap*lBp  -A p*l 

-(l/sJCpAp'lBpLj,  -  CpAp"lL2 


kl 

k2 


(4.24) 


Note  that  the  matrix  L  haa  been  partitioned  into  y,  and  L2  associated  with 
the  low  frequency  and  high  frequency  behavior  respectively.  Fro*  (4.24), 
low  frequency  matching  of  singular  values  occurs  if 

kl  a  -tCpAp-lBp]-l  (4.25) 


Similarly,  at  high  frequency,  (si,  -  Ap)  — *  si.  and 


(si  -  A)-l 


(l/a)I  0 

<l/s2)|p  (l/a)I 

<l/a)I  0 

-<l/s2)|p  d/3)I 

(l/32)CpBpLi  ♦  <1/s>Cpk2 


(4.26) 


Gfol  (s)  [o  Cp] 


kl 

k2 


(4.27) 


As  s  — *  oo,  the  second  term  in  (4.27)  dominates  and  the  singular  values  are 
matched  if 


L-2  =  CpT(CpCpT)-l  (4.28) 

The  L  matrix  (listed  in  Appendix  83)  has  now  been  selected  for  low  and  high 
frequency  matching,  however  the  behavior  of  the  singular  values  at  middle 
frequencies  has  not  been  considered.  Unacceptable  differences  at  these 
frequencies  are  dealt  with  by  appropriate  scaling  of  the  plant  inputs  and 
outputs  such  as  that  described  in  Section  3.3. 

Once  an  appropriate  ^  matrix  has  been  determined,  the  singular  values 
are  shifted  up  or  down  by  varying  the  scalar  parameter  p  until  the  desired 
crossover  frequency  is  obtained.  The  value  of  p  *  132  produced  the  desired 
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maximum  crossover  frequency  of  0.1  radians/second.  Figure  4.3a  shows  the 
plot  of  <Ji  { (s)  1  for  these  paraaeters. 

Now,  using  the  p  and  L  such  th6t  meet  the  desired  specifications,  the 
FARE  is  solved  and  the  Filter  Gain  Matrix  H  determined  from  (4.12).  Next, 
the  singular  values  of  the  Kalman  Filter  d\(G^f(s)}  are  calculated  as  shown 
m  Figure  4.3b  and  compared  to  the  performance  specifications.  This  is  the 
"loop  shape"  of  G(s)K(s)  which  resuits  from  the  Kwaakernaak  recovery. 

The  next  step  in  the  LQG/LTR  process  is  solution  of  the  CARE  (the  MIMO 
transaission  zeros  have  already  been  checked  in  Section  3.4)  and 
calculation  of  the  Control  Gain  Matrix  using  (4.14).  Using  the  H  and  G 
matrices,  the  compensator  K(s)  is  calculated  using  (4.6)  and  the  singular 
values  of  the  Loop  Transfer  Matrix  G(a)K(a)  are  compared  to  the  singular 
values  of  the  Kalman  Filter  loop.  As  stated  in  Section  4.2,  satisfactory 
recovery  is  said  to  occur  when  <31  (G(a)K(a) )  match  <31  CGj<f(a) )  for  at  least 
one  decade  peat,  crossover.  Figure  4.3c  shows  the  recovered  singular  value 
loop  shape  for  q  =  105.  The  crossover  bandwidth  for  this  design  was  from 
approximately  0.05  to  0.1  radians/second.  The  G  and  H  matrices  are  listed 
in  Appendix  B3. 

As  stated  in  Section  3.5,  the  integrators  are  actually  part  of  the 
final  compensator  matrix  £4(3).  The  final  compensator  must  also  include 
the  effects  of  scaling  on  the  inputs  and  outputs.  Figure  4.4  shows  the 
block  diagram  representation  of  the  resultant  closed  loop  system.  The 


singular  values  for  the  LOG  compensator  K(s)  and  the  augmented  and  scaled 
compensator  Ka(s>  are  shown  in  Figures  4.5a  and  4.5b  respectively.  Fro* 
these  singular  value  plots,  the  lead-lag  characteristics,  particularly  the 
effects  of  the  integrators  at  low  frequency,  are  evident.  The  spread  in 
singular  values  at  frequencies  below  crossover  reflects  the  different 
amplification  requirements  for  certain  directions  so  that  the  singular 
values  of  the  recovered  Loop  Transfer  Matrix  GCs)K(a)  match. 

The  singular  values  of  the  closed  loop  plant  as  defined  by  (4.3)  are 
shown  in  Figure  4.6.  They  reflect  the  desired  chararacteristic  of  0  db 
gain  until  crossover  or  break  frequency  and  at  least  2  pole  rolloff 
(-40  db/decade)  after  crossover.  The  poles  and  zeros  of  the  open  loop  and 
closed  loop  systesa  are  found  in  Appendix  34. 

By  examining  the  transfer  function  matrix  for  the  loop  broken  at  the 
plant  input,  information  can  be  obtained  on  how  the  control  inputs  vary 
with  respect  to  reference  commands.  The  transfer  function  relating  r(s>  to 
u(s)  is  given  by 

u(s)  =  (I  ♦  X(s)G(s)>-l  K(s)  r(3>  =  &><*>£.(»>  (4.29) 

Figure  4.7  shows  the  singular  values  for  the  frequency  range  of  interest. 
The  spread  in  singular  values  indicates  that  certain  directions  have  higher 
gains  than  others.  The  singular  value  decomposition  of  (4.29)  shown  in 
Figure  4.3  allows  us  to  examine  the  coupling  of  reference  commands  to 
control  inputs.  The  singular  value  decomposition  was  accomplished  in  the 
manner  discussed  in  Section  3.4  on  plant  eigenstructure.  From  Figure  4.8, 
we  see  that  for  the  controller  responds  to  a  depthrate  command  with 

deflection  of  the  fairwatar  planes  which  makes  physical  sense.  For  022>  it 


is  evident  that  if  a  yawrate  command  causes  deflection  of  the  rudder  and 


o 


Figure  4.8  Singular  Value  Decomposition  of 


the  sternpianes.  The  rudder  obviously  deflects  to  induce  the  yawrate. 
Movement  of  the  sternpianes  can  be  attributed  to  differential  deflection  to 
counter  the  initial  roll  angle  caused  by  the  rudder  deflection  and  the 
steady  state  roll  angle  induced  by  crossflow  over  the  sail.  Furthermore, 
the  033  information  indicates  that  roll  commands  will  cause  the  rudder  and 
sternpianes  to  respond.  Differential  sternplane  deflection  is  obviously 
the  only  feasible  way  to  control  roll  so  the  question  arises  as  to  why  the 
rudder  deflects  so  much.  This  is  most  likely  due  to  the  coupling  between 
the  rudder  and  sternpianes.  Finally,  G44  shows  that  a  pitch  command 
results  in  deflection  of  the  sternpianes.  In  this  case  we  would  expect 
deflection  in  the  same  general  direction  with  possible  alight  differences 
due  to  induced  roll  angles. 

4.4  Preliminary  Testing  of  the  Compensator 

As  a  preiude  to  further  analysis,  preliminary  testing  of  the 
compensator  was  performed  to  gain  some  insight  on  possible  limitations  of 
the  design.  Simulations  were  performed  for  single  command  inputs  and 
multiple  command  inputs  using  step  and  square  commands. 

First,  a  series  of  simulations  were  made  to  examine  the  effects  of 
symmetry  on  the  response  of  the  submarine.  Figure  4.9  shows  the  results  of 
the  IS  knot  nonlinear  simulations  for  ±1  degree/second  yawrate  step  inputs 
applied  at  t  =  5  seconds  and  removed  at  t  3  75  seconds.  As  the  submarine 
enters  into  the  turn,  it  initially  roils  slightly  outward  and  then  due  to 
the  large  force  generated  by  crossflow  over  the  sail,  snap  rolls  inward. 

To  counter  this  effect,  the  sternpianes  deflect  differentially  to  generate 
a  righting  moment  which  drives  the  roll  angle  to  zero.  To  counter  the 
effect  of  the  initial  rudder  deflection  on  pitch  and  depthrate,  there  is 
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slight  Movement  of  the  fairwater  pianes.  The  slight  differences  which  do 
exist  are  most  likely  due  to  propeller  torque  with  a  smaller  contribution 
probably  due  to  the  -1  degree/second  command  (turn  to  port)  being  in  the 
direction  of  the  nominal  point  whereas  the  *1  degree/second  (turn  to 
starboard)  is  in  the  opposite  direction. 

Another  maneuver  which  demonstrates  motion  about  a  plane  of  symmetry 
is  displayed  in  Figure  4.10.  At  t  =  5  seconds,  a  *5  roll  angle  step  input 
is  applied.  The  sternpianes  deflect  differentially  to  a  steady-state  valu 
of  approximately  ^7.5  degrees  to  achieve  the  desired  roll  angle.  The 
rudder  and  fairwater  pianes  deflect  only  slightly  in  reaction  to  the 
initial  transients  and  then  go  to  zero. 

Various  other  maneuvers  were  simulated  for  depthrate  with  and  without 
pitch  to  ensure  control  surface  deflections  for  motion  in  the  vertical 
plane  were  practical.  The  results  of  the  simulation  for  a  1  foot/second 
depthrate  are  presented  in  Figure  4.11.  The  singular  value  decomposition 
in  Figure  4.8  predicts  that  the  fairwater  planes  should  deflect  in  response 
to  this  reference  command.  This  does  indeed  occur  as  shown  in  Figure  4.11 
and  is  accompanied  by  a  saail  deflection  of  the  sternpianes  which  produce  a 
moment  to  counter  the  slight  trimming  moment  induced  by  the  fairwater 
planes. 

Figure  4.12  shows  the  results  of  the  simulation  for  a  4.5  feet/second 
at  -10  degree  pitch.  The  initial  decrease  is  attributed  to  the  additional 
drag  generated  by  movement  of  the  control  surfaces.  As  the  control  surface 
movements  decrease,  forward  speed  is  regained.  The  small  transient 
disturbances  in  the  states  are  a  result  of  of  control  surface  deflection 
and  to  a  lesser  degree,  mild  cross-coupling.  Referring  again  to  the 
singular  value  decomposition  in  Figure  4.8  (d^i  and  644),  one  would  predict 
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deflection  of  the  fairwater  pianes  in  response  to  the  depthrate  command, 
aternpiane3  in  response  to  the  ordered  pitch  angle  and  minor  deflection  of 
the  rudder.  Figure  4.12  confirms  this  to  be  the  case. 

Subsequently,  simulations  which  fiexed  the  compensated  system  in  the 
vertical  and  horizontal  planes  of  motion  simultaneously  were  made  at  speeds 
from  IS  to  30  knots  as  a  prelude  to  gain  scheduling.  These  simulations  and 
guatif ication  for  not  employing  gain  scheduling  are  discussed  in  Chapter  S. 


The  first  section  of  this  chapter  covered  the  LQG/LTR  methodology  for 
robustness  and  performance  at  the  plant  output.  Next,  the  design  and 
analysis  of  the  linear  compensator  for  the  S1SR1  model  were  presented. 
Finally,  results  of  some  simulations  at  IS  knots  were  presented.  These 
simulations  demonstrated  the  symmetry  of  yawrate  and  roll  angle  and 
confirmed  the  predictions  of  the  singular  value  decomposition  for  the 
transfer  function  relating  the  control  inputs  to  the  reference  commands. 
Chapter  5  will  cover  some  additional  simulations  which  were  performed  for 
speeds  from  IS  to  30  knots.  A  comparison  to  the  compensator  designed  by 
Martin  [31  is  also  presented. 


CHAPTER  5 


ADDITIONAL  ANALYSIS  OF  THE  COMPENSATOR 


5.1  Introduction 

This  chapter  covers  additional  analysis  perforaed  on  the  compensator 
designed  for  the  S15R1  linear  nodei  at  speeds  froa  15  to  30  knots.  This  is 
followed  by  a  comparison  to  the  S30R1  compensator  designed  by  Martin  [81 . 

As  a  result  of  this  analysis,  it  was  deteramed  that  while  gain  scheduling 
would  offer  improved  perforaance,  it  was  not  required  to  assure  a  closed 
loop  stable  system  and  therefore  would  not  be  implemented. 

5.2  Additional  Analysis  of  S15R1  Compensator 

It  has  been  shown  that  using  active  roll  control  through  differential 
deflection  of  the  sternplanes  reduces  the  depth  excursion  problem 
experienced  by  a  high  speed  submarine  in  a  turn.  In  this  section,  it 
becomes  obvious  that:  active  roll  control  also  provides  improved  perforaance 
for  depth  changing  and  coordinated  maneuvers  over  a  wide  speed  range. 

To  implement  a  gain  scheduling  scheme,  linear  compensators  must  be 
designed  for  various  discrete  speeds  in  the  speed  range  of  interest.  A 
question  arises  as  to  how  to  select  those  discrete  speeds.  In  this  case, 
quantifying  the  modelling  error  between  the  linear  model  and  the  actual 
plant  is  difficult.  We  can  use  the  robustness  singular  value  inequalities 
(3.10)  and  (3.11)  in  a  similar  manner  by  assuming  the  linear  model  at  one 
speed  is  the  real  system  G(s),  the  linear  model  at  another  speed  is  the 


model  G(s)  and  using  the  relationships  (3.3)  and  (3.9)  as  a  gauge  o£  the 
errors  between  the  nodels.  This  is  not  strictly  accurate  representation  or 
the  errors  and  the  following  comments  should  be  kept  in  mind.  Due  to  this 
assumption,  the  error  between  the  S15R1  model  and  the  actual  30  knot  system 
is  probably  larger  in  some  directions  and  smaller  in  others.  The 
inequalities  provide  a  conservative  estimate  of  stability  robustness  so 
that  the  system  may  be  stable  even  if  the  relations  (3.10)  and  (3.11)  do 
not  hoid.  These  two  conditions  tend  to  offset  one  another  and 
determination  of  system  stability  must  be  confirmed  through  extensive 
simulation. 

A  comparison  of  the  singular  values  of  the  S15R1  and  S30R1  linear 
models  is  shown  in  Figure  5.1.  At  low  frequency,  the  singular  values  of 
S15R1  are  generally  lower  than  those  of  S30R1  with  the  exception  of  the 
minimum  singular  values  which  are  identical  up  to  approximately  0.05 
radians/second.  We  see  that  use  of  integral  augmentation  has  increased  the 
gain  of  ali  singular  values  by  approximately  60  dB  at  0.001  radians/second 
and  has  shifted  the  maximum  crossover  frequency  somewhat  higher.  The  state 
space  matrices  for  S3CR1  can  be  found  in  Appendix  Cl. 

Preliminary  simulations  showed  that  the  compensator  designed  for  the 
15  knot  model  adequately  controlled  the  nonlinear  model  even  at  30  knots. 
Assuming  the  S30R1  model  as  representative  of  the  real  or  nominal  system 

/v 

G(3)  and  the  S15R1  model  as  the  system  model  G(s),  we  can  get  a  feel  for 
the  error  of  the  S15R1  model  at  30  knots.  Figure  5.2  shows  the  comparison 
of  the  singular  values  of  Cl.  ♦  (G(s)K(s) ) "1]  and  Cl  ♦  G(s)K(s)]  with  the 
singular  values  of  CL(s)  -  II  and  CL‘l(s)  -  J]  and  reveals  that  the 
singular  value  inequalities  (3.10)  and  (3.11)  do  not  hold.  As  previously 
stated,  the  relations  provide  a  conservative  estimate  of  stability  and  the 
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5.2 


direction  of  the  instability  (if  it  does  exist)  must  be  determined  through 
testing.  The  results  of  some  nonlinear  simulations  for  the  15  knot 
compensator  are  now  presented  to  support  this  claia. 

The  maneuvers  presented  in  Chapter  4  were  rerun  for  various  speed 
between  15  and  30  knot3  with  favorable  results.  Since  these  maneuvers  were 
not  very  stressful,  two  maneuvers  which  fiexed  the  system  were  simulated. 
The  first  maneuver  consisted  of  a  combined  dive  and  turn  performed  at  15 
knots,  at  30  knots,  as  speed  increased  from  15  to  30  knots  and  finally  as 
speed  decreased  from  30  to  15  knots.  The  maneuver  begins  with  a  4.5 
feet/second  depthrate,  -10  degree  pitch  angle  and  -2  degree/second  yawrate 
initially  applied  at  t  =  5  seconds.  At  t  =  80  seconds,  the  yawrate  command 
is  zeroed,  followed  at  t  s  130  by  the  depthrate  and  pitch  commands. 

Results  of  these  simulations  were  satisfactory.  For  the  sake  of  brevity, 
only  the  speed  change  maneuvers  are  presented.  Figure  5.3  shows  the 
results  with  the  IS  to  30  knot  run  on  the  left.  Both  simulations  were 
completed  without  encountering  instability  however,  there  were  notable 
differences  in  the  yawrate  command  following  and  minor  differences  in  depth 
change.  The  roll  angle  for  both  simulations  was  adequately  controlled 
after  the  initial  transients  due  to  control  surface  movement  died  out. 
Maximum  pitch  errors  of  approximately  3  degrees  and  2  degrees  respectively 
were  experienced.  The  bottom  line  of  this  maneuver  though  was  to  effect  a 
course  and  depth  change  through  appropriate  rate  commands  during  a  speed 
change  to  stress  the  system.  Considering  the  time  the  rate  commands  were 
in  effect,  the  depth  should  have  increased  to  approximately  1060  feet  and 
the  course  change  have  been  150  degrees.  The  15  to  30  knot  simulation 
displayed  some  overshoot  in  depth  but  both  converged  to  within  a  few 
percent  of  the  intended  depth  as  did  the  30  to  15  knot  simulation.  Even 
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though  the  yawrate  command  following  for  the  30  to  15  knot  was  not  felt  to 
be  adequate,  both  simulations  converged  on  a  150  decree  course  change. 

The  second  maneuver  consisted  of  a  dive  with  an  ordered  roll  angle 
during  speed  changes  such  as  that  in  the  previous  maneuver.  At  t  -  5 
seconds,  a  20  degree  roll  angle.  4.5  feet/second  depthrate  and  -10  degree 
pitch  angle  were  ordered.  The  20  degree  roll  angle  resains  for  the  entire 
simulation  however,  the  depthrate  and  pitch  angle  orders  are  removed  at 
t  =  130  seconds.  Figure  5.4  shows  the  results  with  the  15  to  30  knot 
simulation  on  the  left  again.  The  simulation  for  15  to  30  knots  showed 
favorable  results  by  maintaining  the  ordered  20  degree  roll  angle.  The 
depthrate  and  pitch  angle  responses  exhibited  some  overshoot  but  were 
converging  on  the  commanded  values  as  the  fairwater  planes  came  out  of 
saturation.  Throughout  the  maneuver  only  slight  disturbances  to  the 
yawrate  were  present.  The  30  to  15  knot  simulation  showed  that  the  system 
was  stable,  but  due  to  the  speed  decrease,  the  roll  angle  could  not  be 
maintained  as  is  evident  by  sternplane  saturation  at  t  =  95  seconds. 


■ 

5.3  Comparison  of  15  and  30  Knot  Compensators  > 

Since  the  15  knot  compensator  performed  adequately,  the  next  logical 
step  was  to  determine  how  it's  performance  at  various  speeds  compared  to  1 

the  compensator  designed  by  Martin  for  the  30  knot  model.  For  details  of 
the  design  as  well  as  a  comparison  to  a  system  without  active  roll  control  ! 

the  reader  is  referred  to  C83 .  The  matrices  for  the  30  knot  compensator  i 

are  found  in  Appendix  C2. 

First,  several  benign  maneuvers  were  performed  to  observe  how  the 
control  inputs  and  outputs  of  the  two  systems  responded.  The  first  set  of 
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simulations  shown  in  Figures  5.5  and  5.8  were  for  a  -1  degree/second 
yawrate  step  input  applied  at  t  =  5  seconds  at  speeds  of  15  and  30  knots 
respectively.  The  response  for  the  15  knot  compensator  is  on  the  left  and 
the  30  knot  on  the  right.  In  general,  both  exhibited  good  command 
following  with  the  30  knot  compensator  reaching  the  commanded  yawrate 
quicker.  It  is  evident  that  this  occurs  because  the  control  surfaces  move 
much  faster  than  the  15  knot  compensator.  It  should  also  be  noted  that 
this  causes  major  disturbances  to  the  states  and  other  outputs  as  compared 
to  the  15  knot  compensator.  Of  particular  interest  is  that  the  15  knot 
compensator  showed  more  oscillation  at  30  knots  and  the  30  knot  compensator 
showed  more  oscillation  at  15  knots.  This  is  due  to  the  particular 
simulation  being  far  from  the  nominal  point.  The  oscillations  for  the 
system  using  the  30  knot  compensator  were  generally  of  larger  amplitude 
than  those  of  the  system  with  the  15  knot  compensator.  This  set  of 
simulations  was  followed  by  a  similar  set  for  a  1  foot/second  depthrate 
with  similar  results. 

The  two  maneuvers  presented  in  Section  5.2  above  were  then  repeated 
for  the  30  knot  compensator.  The  results  of  the  simulations  are  again 
shown  with  the  15  knot  compensator  on  the  left  and  the  30  knot  compensator 
on  the  right.  The  30  to  15  knot  simulation  for  the  turn  and  dive  i3 
presented  in  Figures  5.7.  The  results  are  generally  the  same  as  previously 
stated.  The  30  knot  compensator  responds  quicker,  is  more  oscillatory  and 
exhibits  more  overshoot.  Of  particular  interest  though  is  the  saturation 
of  the  fairwater  planes  at  t  =  80  seconds  due  to  the  sternplanes  deflecting 
quicker  than  those  of  the  15  knot  compensator  as  the  yawrate  command  i3 
removed.  This  results  in  growing  errors  in  pitch  and  depthrate  until  these 
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Figure  5.6  Comparison  of  15  Knot  and  30  Knot  Compensator 
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commands  are  reaoved.  The  results  of  the  roll  and  dive  aaneuver  provided 
siailar  results  and  are  therefore  not  presented. 

As  shown  in  Figure  5.8,  very  interesting  results  were  obtained  when 
the  simulation  was  repeated  for  15  to  30  knots.  The  results  are  siailar 
until  the  yawrate  command  is  reaoved.  At  that  time,  the  system  with  the  30 
knot  compensator  experiences  a  large  snap  roll,  almost  twice  that  of  the  15 
knot  compensator.  At  t  =  110  seconds,  the  fairwater  planes  of  the  30  knot 
compensator  saturate  which  the  system  also  handles  but  with  a  larger  error 
in  pitch  and  depthrate.  At  t  =  130  however,  the  pitch  and  depthrate 
commands  are  zeroed  and  the  system  goes  unstable  in  the  vertical  plane  as 
evidenced  by  the  growing  depthrates  and  pitch  angles  and  repeated 
saturation  of  the  fairwater  planes  and  the  oncoming  saturation  of  the 
sternplanes. 

As  shown  by  Martin,  the  30  knot  compensator  performs  well  for  large 
yawrates.  It  appears  then  that  the  problem  arises  only  for  motion  in  the 
vertical  plane.  The  reason  or  reasons  why  the  system  with  the  30  knot 
compensator  goes  unstable  and  the  system  with  the  15  knot  compensator  does 
not  are  unknown  but  the  following  is  offered  aa  a  poaaible  explanation. 

(1)  The  higher  crossover  frequency  for  the  30  knot  compensator 
causes  the  control  surfaces  to  move  faster.  These  quick 
movements  result  in  quicker  control  surface  saturations  resulting 
in  large  intergated  errors. 

(2)  Since  we  are  operating  away  from  the  nominal  design  point,  the 
model  is  no  longer  accurate  for  motion  in  the  vertical  plane. 

<3)  The  drag  terms  associated  with  the  IS  knot  compensator 

simulation  are  actually  4  times  larger  at  30  knots  than  at 
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Figure  5.8  Coaparlaon  of  15  Knot  and  30  Knot  Cowpenaatora  for 
Simultaneous  Turn  and  Dive  (15  to  30  Knots) 


15  knot.3  (drag  is  proportional  to  velocity  squared)  where  the 
compensator  was  designed.  This  has  sufficiently  slowed  the 
system  response  at  30  knots,  particularly  in  the  directions 
related  to  motion  in  the  vertical  plane. 

Determination  of  the  exact  cause  is  a  subject  which  requires  further 
research.  In  any  case,  the  30  knot  does  exhibit  better  performance  in  mild 
maneuvers  so  to  implement  a  global  control  system  for  the  submarine  at 
various  speed  and  for  variouys  maneuvers,  there  may  be  some  merit  to  using 
a  quick  controller  for  mild  maneuvers  and  a  slower  controller  for  more 
radical  maneuvers. 

As  a  result  of  this  analysis,  it  was  determined  that  implementing  a 
gain  scheduling  algorithm  would  not  be  feasible  without  either  redesigning 
the  30  knot  compensator  for  a  lower  crossover  frequency  or  limiting  the 
maneuvers  at  higher  speeds.  As  shown  by  Lively  [7],  implementing  a  gain 
scheduling  scheme  is  rather  straightforward  and  in  this  case,  it  was  felt 
that  nothing  new  would  be  learned  from  the  exercise. 


5.4  Summary 

This  chapter  has  covered  some  of  the  more  stressful  maneuvers  which 
the  15  knot  compensator  performed.  The  30  knot  compensator  exhibited 
better  behavior  for  less  stressful  maneuvers  and  at  lower  speeds  where  the 
quick  control  surface  movements  did  not  excite  any  instabilities  like  it 
did  at  higher  speeds.  As  a  result  of  this  comparison,  gain  scheduling  was 
not  used  as  it  was  felt  that  more  could  be  learned  from  investigating  the 
effect  of  control  surface  saturation.  The  use  of  an  Antireset  Windup  (ARW) 


feedback  loop  is  investigated  in  Chapter  6 


IMPLEMENTATION  OF  ANTI-RESET  WINDUP  FEEDBACK 


6.1  Introduction 

In  Chapter  5,  it  became  apparent  that  as  the  submarine  is  ordered  to 
do  more  difficult  maneuvers,  control  surface  saturation  enters  into  the 
picture.  While  the  IS  knot  compensator  remained  stable  throughout  the 
testing,  the  30  knot  compensator  did  not.  As  was  evident  in  the 
simulations  presented  in  Chapter  S,  control  surface  saturation  of  the 
fairwater  planes  occurred  frequently  and  in  some  cases  for  long  periods  of 
time.  To  decrease  the  time  required  for  a  control  surface  to  come  out  of 
saturation,  an  Anti-Reset  Windup  (ARW)  feedback  loop  is  installed.  The 
chapter  begins  with  a  discussion  of  the  ARW  feedback  loop.  Thi3  is 
followed  by  an  analysis  of  the  impact  of  the  ARW  loop  on  the  open  loop  and 
closed  loop  systems.  Finally,  several  simulations  which  demonstrate  the 
use  of  ARW  are  presented. 


6.2  ARW  Feedback  Loop 

As  a  result  of  prolonged  control  surface  saturation,  the  system 
experiences  a  phenomena  known  as  integrator  windup  or  reset  windup.  The 
delay  in  the  control  surface  or  surfaces  coming  out  of  saturation  after  the 
saturating  condition  is  no  longer  in  effect  is  caused  by  the  integration  of 
the  error  between  the  ordered  deflection  and  the  saturation  level,  if  the 


error  is  large  and/or  the  period  of  saturation  is  long,  the  integrated 
error  may  also  become  large  and  quite  significant  delays  can  be 
encountered.  To  counter  thi3  problem,  a  nonlinear  feedback  loop  is 
employed  whose  effect  is  to  "turn  off"  the  integrator  for  the  saturating 
actuator. 

The  use  of  ARW  strategy  in  a  hlhO  control  system  is  not  fully 
developed  and  the  method  employed  here  is  based  on  [271  and  personal 
interactions  with  it3  authors,  Xapasouns  and  Athan3.  Figure  6.1  snows  the 
closed  loop  system  with  the  ARW  feedback  loop  installed  around  the 


Figure  6.1  Structure  of  the  Closed  Loop  System  With  ARW 

integrators.  The  nonlinearity  prior  to  the  plant  represents  the  saturating 
control  surfaces  of  the  submarine,  with  the  saturation  limits  as  listed  in 
Table  3.1.  When  the  control  surfaces  are  not  in  saturation,  the  feedback 
loop  is  "deenergised"  through  the  "dead-zone"  as  shown.  As  a  control 
surface  saturates,  the  feedback  loop  for  that  control  channel  energizes. 

As  a  result  of  this  feedback,  the  integrator  is  replaced  by  a  lag  network 
as  3hovn  by  (6.1).  The  amount  of  feedback  used  is  a  function  of  the 

u(s>  =  <I/3)CI  ♦*<I/s>  3_1  K<s)  e(s) 


=  K(s)  Cl/ (a  ♦  «)]  e(s) 


(6.1) 


variable  &<  in  the  loop  but  the  net  effect  of  the  feedback  is  to  reduce  the 
gain  at  low  frequency.  Figure  6.2  shows  the  effect  of  the  parameter  °<  on 
the  Bode  plot  of  a  lag  network.  As  o< is  decreased,  the  behavior  of  the 


loop  approaches  that  for  the  integrator.  As  «  i3  increased,  the  gain  at 
low  frequency  decreases.  At  present,  there  is  no  known  straighforward 
method  for  selecting  «,  especially  for  the  MIMO  case.  To  gain  3oae  insight 
on  a  method  of  selection,  several  areas  were  examined. 

Figure  6.3  shows  the  effect  the  ARW  method  ha3  on  the  singular  values 
of  the  loop  transfer  matrix  G(s)K(s)  where  G(s)  now  contains  the  dynamics 
of  the  ARW  feedback  loop  instead  of  the  integrators  as  presented  in  Section 
3.5.  At  low  frequencies,  the  singular  values  have  spread  with  two  showing 
slight  increases,  one  a  slight  decrease  and  the  one  associated  with  the 
saturated  control  surface  a  drastic  decrease.  When  oc  was  decreased  by  a 
factor  of  1/2  from  0.1  to  0.05,  the  minimum  singular  value  increased  by  a 
factor  of  2  or  6  dB.  There  was  little  or  no  effect  on  the  transfer 
function  relating  reference  commands  to  control  inputs  C4.30)  or  it3 


singular  value  decomposition.  Finally,  the  effect  on  the  singular  values 


of  the  closed  loop  system  for  c<  =  0.05  is  shown  in  Figure  6.4.  Again, 
spreading  of  the  singular  values  occurs  at  low  frequency  and  one  would 
expect  problems  in  the  channel  with  the  -10  dB  minimum  singular  value.  For 
this  design  then,  the  only  noticabie  effect  is  on  the  singular  values  and 
not  the  singular  vectors.  Therefore,  selection  of  the  parameter  ®<  appears 
to  be  based  on  how  much  the  minimum  singular  value  of  the  unaugmented 
system  needs  to  be  increased  at  low  frequency  to  assure  acceptable  command 
performance.  In  the  next  section,  several  simulations  which  show  the  merit 
of  using  an  ARW  feedback  loop  are  presented. 


6.3  Simulations  for  System  With  ARM  Feedback 

Using  the  ARW  feedback  loop  as  described  in  Section  6.2,  several 
simulations  were  made  for  various  values  of  ©<.  Because  the  minimum 
singular  value  of  G(s)K(s>  exibits  such  a  large  dependence  on  0<,  it  was 
thought  that  to  have  adequate  performance  and  robustness,  oC  would  have  to 
be  selected  such  that  the  value  of  the  minimum  singular  value  was  at  least 
20  dB  at  low  frequency,  consistent  with  the  low  frequency  barrier  in  Figure 
3.6.  This  proved  not  to  be  the  case  as  an  o<  of  0.05  seemed  to  provide 
adequate  command  following.  This  may  only  be  sufficient  for  the  series  of 
tests  performed  by  the  author.  Additional  testing  may  indeed  indicate  that 
command  following  is  not  satisfactory  for  some  combination  of  command 
inputs.  But  that  is  a  subject  for  further  research. 

Since  saturation  of  the  fairwater  planes  occurs  most  frequently,  the 
first  two  simulations  deal  with  an  ordered  depthrate  with  zero  commanded 
pitch  as  this  would  easily  cause  saturation.  A  comparison  -of  the  closed 


loop  system  response  for  a  2  feet/second  commanded  depthrate  with  and 


without  ARW  feedback  is  shown  in  Figure  6.5.  A  "mild"  saturation  is 
created  by  application  of  the  reference  command  at  t  =  5  seconds.  Noting 
the  change  in  scale  on  the  graphs,  we  see  that  the  responses  remain 
identical  until  t  -  130  seconds  when  the  reference  coamand  is  zeroed.  At 
that  time,  aternplane  and  rudder  deflections  are  the  same  but  a  alight 
difference  in  the  fairwater  plane  deflection  occurs  with  the  ARW  simulation 
displaying  a  slight  overshoot.  Review  of  the  outputs  show  that  the 
oscillations  have  been  effectively  decreased  and  the  output  errors  slightly 
reduced  in  magnitude. 

To  demonstrate  the  effects  of  a  prolonged  "hard"  saturation,  another 
simulation  was  made  with  a  4  feet/second  commanded  depthrate  as  shown  in 
Figure  6.6.  There  is  a  slight  difference  in  the  rudder  and  sternplane 
deflections  but  an  obvious  improvement  in  fairwater  plane  response  is 
noted.  At  t  =  130  seconds  when  the  reference  command  is  zeroed,  the 
fairwater  planes  for  the  system  with  ARW  immediately  deflect  to  reduce  the 
depthrate  to  zero  while  the  fairwater  planes  for  the  system  without  ARW  do 
not  come  out  of  saturation  for  another  110  seconds!  A  comparison  of  output 
variables  again  shows  that  the  ARW  feedback  loop  has  decreased  oscillations 
and  more  importantly,  decreased  the  error  by  as  much  as  a  factor  of  2  in 
the  case  of  depthrate  and  yawrate. 

These  simulations  have  shown  that  for  a  system  which  experiences 
prolonged  control  surface  saturation,  the  use  of  an  ARW  feedback  loop  will 
decrease  oscillations  in  the  outputs  and  sometimes  significantly  decrease 
the  magnitude  of  the  maximum  error.  Additionally,  the  use  of  the  fairwater 
planes  as  an  effective  dynamic  control  input  is  regained  almost  immediately 
instead  of  waiting  until  the  integrated  error  is  nulled. 
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6.4  Suamarv 

This  chapter  has  covered  the  use  of  an  Anti  Reset  Windup  feedback  loop 
to  iaprove  performance  of  the  submarine  in  the  presence  of  saturating 
control  surfaces.  In  particular,  the  effect  on  fairwater  plane  saturation 
was  demonstrated  with  notable  iaproveaents  by  reduction  in  the  oscillation 
and  aaxiaua  error  of  the  output  variables  and  the  tiae  lag  until  dynamic 


control  of  the  saturating  surface  is  regained. 


CHAPTER  7 


SUMMARY  AND  DIRECTIONS  FGR  FURTHER  RESEARCH 


7.1  Summary 

This  thesis  has  presented  the  design  of  a  multivariable  control  system 
for  a  submarine  using  the  Linear  Quadratic  Gaussian  with  Loop  Transfer 
Recovery  (LQG/LTR)  methodology.  The  submarine  model  was  based  on  the  N5RDC 
2510  equations  of  motion  modified  to  include  the  crossflow  terms  of  the 
updated  equations,  differential  control  of  the  sternplanes  and  a  constant 
RPS  constraint  on. the  propeller. 

The  10th  order  linear  model  baaed  on  a  nominal  point  of  15  knots 
forward  speed  and  1  degree  rudder  deflection  was  reduced  to  an  8th  order 
system  and  then  scaled  for  units  and  input/output  weightings.  Using 
LQG/LTR.  a  Model  Based  Compensator  was  designed  for  a  crossover  frequency 
of  0.1  radians/second  for  the  plant  augmented  with  integrators  to  reduce 
steady  state  error  to  step  inputs.  The  design  was  extensively  tested  at 
speeds  from  15  to  30  knots  and  then  compared  to  the  compensator  design  by 
Martin  C8] .  That  design  is  based  on  a  30  knot  model  of  the  same  submarine 
but  has  a  crossover  frequency  of  0.5  radians/second. 

Subsequently,  an  Anti-Reset  Windup  (ARW>  feedback  loop  was 
incorporated  to  reduce  the  effects  of  saturating  control  surfaces  on  the 
dynamic  response  of  the  submarine.  This  is  accomplished  by  replacing  the 
integrator  in  the  input  channel  with  a  simple  lag  when  that  channel  issues 
a  command  above  the  saturation  level  of  the  control  surface. 
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7.2  Conclusions  and  Directions  for  Further  Research 


The  LQG/LTR  multivariable  control  aystea  design  aethodology  has  been 
used  to  design  a  controller  which  considers  rather  than  neglects  the  cross 
coupling  present  in  the  dynamics  of  a  submarine.  This  provides  for  better 
control  over  a  wider  variety  of  aaneuvers  since  the  modei  is  valid  for 
larger  perturbations  than  one  which  is  based  on  decoupled  vertical  and 
horizontal  planes  of  sotion.  Active  roil  control  through  the  differential 
deflection  of  the  sternplanes  also  helps  by  Halting  perturbations  in  roil 
angle  during  maneuvers,  thereby  Halting  cross-coupling. 

The  use  of  aodal  analysis  and  singular  value  decoaposition  have  proven 
to  be  an  excellent  means  of  providing  the  designer  with  insight  on  the 
states  and  control  inputs  which  doainate  the  response  of  the  submarine. 
Additionally,  the  singular  value  decoaposition  of  the  transfer  function 
relating  the  reference  coaaands  to  the  control  inputs  Kr-(s),  provides 
important  inforaation  on  their  coupling,  i.e.  what  control  inputs  are 
generated  in  the  controller  for  a  given  reference  command. 

Comparisons  of  the  15  knot  coapensator  designed  in  this  thesis  and  the 
30  knot  compensator  designed  by  Martin  [8]  indicate  that  a  higher  crossover 
frequency  is  desirable  for  iaproved  performance  during  mild  maneuvers  of 
the  submarine,  but  a  lower  crossover  design  is  preferable  for  more  radical 
maneuvers.  This  was  evident  by  the  instability  experienced  during  the  turn 
and  dive  maneuver  by  the  system  using  the  30  knot  coapensator. 

The  effectiveness  of  an  ARW  feedback  loop  was  demonstrated  in  a  system 
that  experienced  control  surface  saturation.  It  was  determined  that  the 
feedback  parameter  alpha  must  be  selected  such  that  the  gain  of  G(s)K(s) 
remains  high  enough  to  guarantee  adequate  command  following.  There  was  no 
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affect  on  the  singular  value  decomposition  of  Kr-(s)  and  only  a  slight 
effect  on  its  singular  values. 

This  thesis  has  provided  an  avenue  for  advancement  in  Lhe  area  of 
submarine  control  system  design  but  prior  to  any  actual  system  being  built 
and  put  to  sea.  much  more  research  must  be  performed.  This  thesis  and 
Martin's  have  demonstrated  the  advantage  of  using  differential  deflection 
of  the  sternplanes  to  provide  active  roil  control  for  the  submarine. 
Additional  research  is  required  however,  in  the  area  of  casualty  control  in 
the  event  of  a  sternplane  or  other  control  surface  failure.  In  Chapter  5, 
it  was  shown  that  the  IS  knot  and  30  knot  compensators  could  be  operated  at 
speeds  and  operating  points  far  away  from  nominal  but  thatthe  severity  of 
the  maneuver  had  to  be  restricted  for  the  30  knot  compensator  due  to 
instabilities.  The  reason  for  this  unstable  condition  is  mostly  attributed 
to  the  higher  crossover  frequency,  but  the  effect  of  the  higher  nominal 
speed  must  be  investigated.  The  use  of  gain  scheduling  will  obviously  be 
required  for  an  actual  controller  design  which  effectively  controls  the 
submarine  at  all  speeds. 

The  singular  value  decomposition  of  the  plant  and  the  reference  to 
command  input  transfer  function  KfCs),  provided  useful  information  about 
the  coupling  of  the  system  at  low  frequency,  but  the  singular  values  and 
singular  vectors  change  as  a  function  of  frequency.  Additional  research  in 
this  area  will  provide  insight  into  how  the  coupling  of  the  system  changes 
as  a  function  of  frequency. 

The  last  area  which  requires  further  research  is  the  use  of  Anti -Reset 
Windup  feedback.  The  improvement  in  the  submarine's  performance  was 
evident,  but  the  method  of  selecting  the  feedback  parameter  o(  needs 
further  development.  Additionally,  the  effect  of  prolonged  multiple 
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APPENDIX  a: 


ORIGINAL  PLANT  MATRICES  PRIOR  TO  SCALING  AND  MODEL  REDUCTION 

A  MATRIX 

(10  »  10) 

•1.9012E-02  -I . 1096E-02 

-4.2241E-04  -9.5941E-03 

-1.6033E-02 

1.3933E+00 

O.OOOOE+OO  2.9550E-04 

O.OOOOE+OO 

O.OOOOE+OO 

5.3344E-04  -8.0771E-02 

3. 4449E-04  -4.44B2E-01 

9.48B2E-02 

-7.8144E+00 

1.3174E-01  -3.4021E-05 

O.OOOOE+OO 

O.OOOOE+OO 

7. 2953E-06  -7.8932E-05 

-5.3842E-02  -8.0323E-01 

4.1384E+00 

9.7422E-03 

O.OOOOE+OO  7.4175E-03 

O.OOOOE+OO 

O.OOOOE+OO 

1. 1097E-04  -5.8724E-03 

-7. 1679E-04  -2.2072E-01 

-1.2851E-01 

-1 . 4504E-02 

-1.4204E-01  4.1845E-05 

O.OOOOE+OO 

O.OOOOE+OO 

■4.5774E-07  -2.2004E-06 

4.7287E-04  -5.7394E-03 

-2.0482E-01 

1.4001E-04 

O.OOOOE+OO  -2.5124E-03 

O.OOOOE+OO 

O.OOOOE+OO 

•1.3843E-05  -1.0317E-03 

3.7870E-04  -3.5813E-03 

4.7420E-04 

-1.9379E-01 

2.4177E-04  -4.7592E-08 

O.OOOOE+OO 

O.OOOOE+OO 

0. OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  1. OOOOE+OO 

2. 381  IE-04 

-9. 1343E-03 

-1.3327E-12  -4.2735E-03 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

9.9940E-0I 

2.8184E-02 

4. 2730E-03  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

0.0000E+00  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

-2.8184E-02 

9. 9965E-01 

1.4553E-1Q  5.7451E-05 

O.OOOOE+OO 

O.OOOOE+OO 

9. 1574E-03  -2.8183E-02 

9.9954E-01  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

7.9107E-01  -2.4818E+01 

O.OOOOE+OO 

O.OOOOE+OO 

B  NATRIJ 

[  (4  x  10) 

-4.2090E-04 

-1.5045E-02 

7.2244E-04 

7.2244E-04 

O.OOOOE+OO 

5.9404E-01 

-4.3727E-02 

4.3727E-02 

-3.7257E-0I 

-3.8218E-07 

-2.5391E-01 

-2.5391E-01 

O.OOOOE+OO 

1.0988E-02 

3.3783E-02 

-5.3783E-02 

3. S7B6E-03 

1.2405E-07 

-6.1424E-03 

-4. 1424E-03 

O.OOOOE+OO 

-1.3105E-02 

-8.4874E-05 

8.4874E-05 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 
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APPENDIX  A 2 


MATRICES  TO  PERFORM  UNIT  TRAWSPORWATIOHS 

Matrix  used  to  praaultiply  tha  A  and  B  utricis: 


l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  5.7300E+01  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.7300E+01 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOQE+OQ  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
3.7300E+01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  5.7300E+01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  5.7300E+01  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  5.7300E+OI  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  l.OOOOE+OO 


llatrix  Mad  to  poataaltiply  the  ft  utrix: 


l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  l.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.7432E-02  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.7452E-02 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
1.7452E-02  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  1.7452E-C2  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  1.7452E-02  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.74S2E-02  O.OOOOE+OO 
O.OOOOE+OO.  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  l.OOOOE+OO 
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a?P£.\~d:x  \2 


Ratrix  ustd  to  postaultipl y  th»  B  aatnx: 


1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

Ratrix  u»d  to  priaultipiy  the  C  aatnx: 

S.7300E+01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

5.7300E+01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

5.7300E+01 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

Ratrix  uwd  to  postauitiply  till  C  aatnx: 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7432E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

1.7452E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 
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ap?::;:::-:  a2 


PLANT  MATRICES  SCALED  FOR  UNIT  TRANSFORMATION  ONLY 


-1.9012E-02  -1.1Q96E-02  -4.2241E-04 
5.8364E-04  -8.0771E-02  3.4469E-04 
7.2953E-06  -7.8932E-05  -5.38A2E-02 
6.3584E-03  -3.3650E-01  -4. 1072E-02 
-3.7689E-05  -1.2608E-04  3.8555E-02 
-7.9321E-04  -5.9U6E-02  2.1699E-G4 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


A  MATRIX  (8  »  8) 

-1.6744E-04  -2.7984E-04  2.7806E-02 
-1.1288E-02  1.S559E-03  -1.3641E-01 
-1.4018E-02  1.0713E-01  1.7002E-04 
-2.2072E-01  -1.2851E-01  -1.4504E-02 
-5. 7594E-03  -2.0682E-01  1.400IE-04 
-3.5813E-03  4.7420E-04  -1.9379E-01 
1 . OOOOE+OO  2.581  IE-04  -9.1343E-03 
O.OOOOE+OO  9.9960E-01  2.8184E-02 


O.OOOOE+OO 
2.2994E-03 
O.OOOOE+OO 
-1.6206E-01 
O.OOOOE+OO 
2.6I77E-04 
-1. J327E-12 
6.2730E-03 


8  mm  (8  x  4) 

-7.3455E-06  -2.6291E-04  I.2608E-05  1.2608E-05 
O.OOOOE+OO  1.0402E-02  -7.A312E-04  7.6312E-04 
-6.5021E-03  -6. 6698E-09  -4.4313E-03  -4.4313E-03 
O.OOOOE+OO  1.0988E-02  5.3783E-02  -5.3783E-02 
3.5786E-03  1.2A05E-07  -A.1424E-03  -6.1424E-03 
O.OOOOE+OO  -1.5I05E-02  -8.6874E-05  8.6874E-05 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


5. 1570E-0A 
-5.9374E-07 
1.3294E-04 
4. 1845E-05 
-2.5124E-03 
-6.7592E-08 
-6.2735E-03 
O.OOOOE+OO 
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O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

APPENDIX  A2 

C  MATRIX  (4  *  8) 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO 

l.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO  -2.3185E-02 

9.9964E-01 

1.4552E-I0 

Q.QOOQE+OO 

l.OOOOE+OO 

5.7450E-05 


9.1576E-03  -2.8183E-02  9.9956E-Q1  O.OOOOE+OO  O.OOOOE+OO  0. OOOOE+OO  1.3806E-02  -4.3313E-01 


APPENDIX  A3 


O.OOOOE+OO  0. OOOOE+OO 
O.OOOOE+OO  O.OOOOEtOQ 
0. OOOOE+OO  O.OOOOE+OO 
9.1574E-03  -2.8183E-02 


C  HftTRIX  (4  X  8) 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.Q000E-01  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.0000E-01 
O.OOOOE+OO  O.OOOOE+OO  -2.8185E-02  9.9964E-01  1.4552E-10  5.7450E-05 
9.9954E-01  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.3804E-02  -4.3313E-01 


POLES,  ZEROS  AND  E I  SELECTORS 


•2.0413E-02 

1.4066E-02 


3.1712E+08 


5.4585E-03 
2. 121BE-03 

2.000AE-03 

•1.8330E-03 

•t. 1404E-02 
■7.151AE-02 

-5.2527E-03 

3.3729E-03 

A.0737E-03 
-2. 4203E-02 

-5.3494E-04 

4.9147E-04 

7.7598E-04 

3.7420E-02 

-7.4935E-01 

A.5459E-01 


EI3ENVALUES 


-2.0413E-02 

-2.0418E-02 

-3.3441E-02 

-1.0403E-01  -1.0403E-01 

-2.2040E-01 

-2.47AIE-01 

-1.4044E-02 

O.OOOOE+OO 

O.OOOOE+OO 

3.8084E-01  -3.8084E-01 

O.OOOOE+OO 

O.OOOOE+OO 

TRANSMISSION  ZEROS 

3.3004E+04 

5.83B1E+03 

-1.9007E-02 

-1.2729E-01  -3.3321E+03 

•1.2904E+07 

-7.9457E+08 

EISENVECTORS  (NODAL  MATRIX) 

S.4585E-03 

9.7809E-01 

5. 2178E-01 

-4.3995E-05  -4.399SE-05 

-5.4014E-04 

3.3478E-02 

-2. 1218E-03 

O.OOOOE+OO 

O.OOOOE+OO 

2.9034E-04  -2.9054E-04 

O.OOOOE+OO 

O.OOOOE+OO 

2.000AE-03 

A.9451E-02 

3.4412E-01 

-7.5258E-04  -7.5258E-04 

2.7841E-03 

-3.7199E-01 

1.8330E-03 

O.OOOOE+OO 

O.OOOOE+OO 

1.2834E-02  -1.2S5AE-02 

O.OOOOE+OO 

O.OOOOE+OO 

-1.1404E-02 

1.4131E-02 

4.0004E-02 

7.7844E-03  7.7844E-03 

I.3399E-01 

-4.4995E-03 

7.151AE-02 

O.OOOOE+OO 

O.OOOOE+OO 

1 . 1034E-02  -1.I036E-02 

O.OOOOE+OO 

O.OOOOE+OO 

-5.2527E-03 

1.0482E-03 

2.2280E-02 

3.4240E-01  3. 4240E-01 

-2.2220E-02 

-1.997BE-01 

-3.3729E-03 

O.OOOOE+OO 

O.OOOOE+OO 

-1.3309E-01  1.3309E-01 

O.OOOOE+OO 

O.OOOOE+OO 

A.0737E-03 

4. 7344E-03 

1.5018E-02 

1.8075E-03  1 . 307SE-03 

-2.1241E-01 

-1.73AAE-02 

2.4203E-02 

O.OOOOE+OO 

O.OOOOE+OO 

4.8844E-03  -4.8844E-03 

O.OOOOE+OO 

O.OOOOE+OO 

-5.5494E-04 

-2.84L8E-02 

-1.3I78E-01 

-1.9431E-03  -1.9431E-03 

4.S092E-03 

-4.2313E-01 

-4.9147E-04 

O.OOOOE+OO 

O.OOOOE+OO 

3.0331E-03  -3.0331E-03 

O.OOOOE+OO 

O.OOOOE+OO 

7.7398E-04 

-1. 1242E-01 

-7.3935E-0I 

-5.3490E-01  -3.5490E-01 

1.2854E-01 

7.9343E-01 

•3.7A2QE-02 

O.OOOOE+OO 

O.OOOOE+OO 

-7.4434E-01  7.4434E-01 

O.OOOOE+OO 

O.OOOOE+OO 

-7.493SE-01 

-1.5735E-01 

-1.9903E-01 

1.9041E-03  l.906tE-03 

9.5910E-01 

9.8394E-02 

-A.5459E-01 

O.OOOOE+OO 

O.OOOOE+OO 

4.0419E-03  -4.0419E-03 

O.OOOOE+OO 

O.OOOOE+OO 

APPENDIX  32 


7.759BE-04 

3.7A20E-02 

•7.4933E-01 

6.3A59E-01 

■7.A899E-04 
1 . 21 12E-03 


CONTROLLABILITY  HATRIX 


1.6552E-01 

1.0504E-01 

-5.7600E-01 

-1.8233E-01 

1.6552E-01 

1.0504E-01 

5.7600E-01 

1.8233E-01 

-6. 8062E-03 

-3.92A4E-01 

-2.0819E-10 

-1.3146E-09 

4.0734E-03 

7. 1 184E-01 

3. 1612E- 10 

2.7899E-09 

-2.3352E-02 

1 . 2539E-01 

3.4091E-03 

2.8794E-01 

-2.3352E-02 

1.2539E-01 

-3.4091E-03 

-2.8794E-01 

-5.2958E-01 

-2.3894E-02 

-2. 0413E-1 1 

3.4676E-10 

-5. 4850E-03 

2.2961E-01 

-9.9081E-12 

2.1348E-11 

3.5334E-01  3.AA37E-01 
-2.9672E-01  -3.0245E-01 

3.5334E-01  3.6637E-01 
2.9672E-01  3.0245E-01 

-5.A05AE-03  -4.4330E-03 
-3.3261E-09  3.2745E-09 

1.7878E-03  -2. 5278E-03 
6. 1340E-09  -9.1234E-09 

4.3242E-01  -3. 9234E-01 
2.9887E-01  -3.2909E-01 

4.3242E-01  -3.9234E-01 
-2.9887E-01  3.2909E-01 

1.4670E-01  1.3493E-01 
7.9478E-10  6.72&5E-10 

-5.A294E-03  9.4034E-03 
4.4051E-U  -2.7408E-U 


OBSERVABILITY  HATRIX 

7.7598E-04  -1.1242E-01  -7.3933E-01  -5.3A90E-0I  -5.5690E-01  1.285AE-01 

-3.7420E-02  0. OOOOE+OO  0. OOOOE+OO  -7.4456E-01  7.4454E-01  O.OOOOE+OO 

-7. 4933E-01  -1.3753E-01  -1.9903E-01  1.9061E-03  U9061E-03  9.5910E-01 

-4.5A39E-01  0. OOOOE+OO  O.OOOOE+OO  4.04I9E-03  -4.04I9E-03  O.OOOOE+OO 

-7.6899E-04  -2.8351E-02  -1.3217E-01  -I.9932E-03  -1.9932E-03  1.0649E-02 

-1.2U2E-03  O.OOOOE+OO  O.OOOOE+OO  2.8944E-03  -2.894AE-03  O.OOOOE+OO 


7.9363E-01 

O.OOOOE+OO 

9.B394E-02 

O.OOOOE+OO 

-4.2448E-01 

O.OOOOE+OO 


3. 1317E-01  3. 1317E-01  8.7823E-02  1.3101E-01  -7.1196E-04  -7.I196E-04  -2.7979E-01  -2.5367E-02 
■3.5528E-01  3.3328E-01  O.OOOOE+OO  O.OOOOE+OO  -I.3587E-03  I.3387E-03  O.OOOOE+OO  O.OOOOE+OO 


APPENDIX  B3 


MODEL  BASED  COMPENSATOR  MA' 


CONTROL  GAIN  MATRIX  -  S  14  *  12) 


1.9075E+00  1.7309E-02  3.3175E-01  3.3927E-01  -2.2603E+00  6.35B6E+00 
■2.3374E+02  6.0251E-02  1. 1518E+02  2.9BUE+00  -2.4295E+00  1.2755E+02 

1 • 7309E-02  3.6408E+00  2. 7069E-02  -3.3234E-02  B.B669E-02  9.1610E+00 
-4.3139E+00  1.4955E+00  7.0839E+00  -2.8537E+02  1.2667E+00  1.3071E+00 

3.3175E-01  2.7049E-02  2.2OOBE+O0  -4.1713E-01  -1. 1099E+00  -3.42O0E+OO 
-1.3371E+02  2.5322E+01  -1.5522E+01  1.1943E+01  1.736BE+01  4.0942E+01 

3.3927E-01  -5.3234E-02  -4.1713E-01  2.17B0E+00  -1.S532E+00  1.0440E+01 
-1.3407E+02  -2.5040E+01  -1.0521E+01  -3.B677E+00  -2.1052E+01  4.1898E+01 


FILTER  GAIN  MATRIX  -  H  (12  *  4) 


-5.9202E-02 

•3.2113E+00 

•3.B230E-02 

•7.79B3E-01 

3.2310E-02 

B.4010E-03 

-2.4132E-01 

*3. 6334E-03 

i.iteoE+oo 

1.B43OE-01 

-2.B443E-01 

1.6448E-02 

■1.0548E+00 

-7.6073E-02 

3.2537E-01 

5. J944E-02 

9.5416E-04 

2.O79OE-03 

3.5B01E-02 

7.4520E-04 

1 . 9483E-03 

-3.3268E-03 

•8.6929E-02 

•3.5440E-03 

T.0162E-02 

3.7689E-01 

1.0342E-03 

B.7100E-02 

3.2396E-03 

4.0973E-03 

•1.4220E-02 

4.6202E-04 

■3.9137E-03 

-3.8391E-03 

-1.9355E-03 

B.6A03E-03 

■6.6970E-03 

3.1429E-04 

4.5711E-02 

1.3147E-03 

9.2545E-01 

1.3114E-02 

-4.5835E-02 

-3.1O72E-02 

1.3U4E-02 

8.7089E-01 

3.6730E-03 

-J.2924E-03 

OPEN  LOOP  wle; 
<1  i  24) 


REAL  9a»T 


7.10122-09  1.31402-09  4.02CSE-10  4.O2OSE-10  -i. 90072-32  -2.04132-02 
•2.0*132-02  -2.04122-32  -3.34412-02  -i.0o03E-)i  -1.06232-31  -i.2725£-0i 
■2.20402-31  -1  *7oi£— 51  -3.40832-31  -3.40632-31  -7.O970E-OI  -?.0970t-)l 


■7.92252-01  -1.30022-00  -1.30G2E-00  -1.50002*00  -1.92732-00  -1.9273E-00 


SMSIHflftY  PART 

0.0000E~00  0. 00052-00  3.414-2-09  -5.41482-39  0.00002-20  1.40aaE-v2 

■1.40462—32  O.OOOOE-OO  0.  OOOOE^OO  3.30S4E— )1  -3.30S4E— 3i  0.M00E-0Q 

0.00002*00  fl.OOOOErOO  6.00172-31  -6.20172-31  1.3232E-00  -1.32232-00 


0.00002*00  1. 32Q0E*<)0  -i-32C0£*00  0.00002*00  t. 92202-00  -1.9220E-00 


OPEM  LOO?  ZEROS 
C  i  24) 


REAL  PART 

9.28492*02  9.28492*02  1.2343E*02  1.23432-02  t.5i37E*00  1.50992*00 
1.9007E-02  -1 . ?161E— 02  -2.O404E-O2  -2.04042-32  -5.7I43E-02  -1.M19E-01 
1.0419E-OI  -1.27292-01  -2.0323E-01  -2.20752-01  -1.2357E*02  -l.2357E*02 
1. 44632-03  -1.46632*03  -2.03712*03  -4.91962*03  -4.9198E-03  -7.28512*04 


MMiaftRY  PART 

1. 71002-03  -i.7100E*03  1.23492*02  -1.23492*02  *.61912-04  -7.41912*04 
0. OOQQE-OO  0.00002*00  1.40442-32  -i.  40442-02  O.OOOOE-OO  3.74902-01 
3. 74902-31  0.00002-00  0. 00002-00  0.00002*00  1.23492*02  -1.23492*02 
2. 34432*03  -2.3*4«32-03  O.OOOOE-OO  1.44952*04  -1.44952*04  0.00(WE*00 


APPEKSIX  B4 


POLES  AKD  2ERSS  Or  THE  OPEN'  AKD  CLOSED  LOO?  SYSTEMS 


CLSBS3  LCSP  POLES 
(1  :  24) 


REAL  PART 


-1.2917E-02  -1.90G7S-C2  -2.0299E-02  -2.02955-32  ■ 
-E.3722E-02  -S.7075E-02  -9.3104E-02  -i.07*0E-0i 
-2.2005E-01  -2.&290E-01  -3.5428E-01  -3.5428E-01 
-7.1471E-01  -1.25S4S+00  -1.2584E+00  -1.4i2iE+0t‘ 


■4.2237E-32  -4.2237E-02 
.  0740E-01  -1.2729E-01 
-7.0714E-01  -7.G714E-01 
-1.2944E+00  -1.8944E+00 


C.0000E+00  O.OOOOE+OO 
O.OOOOE+OO  C.OOOOE+OC 


IM8IHMY  PART 
I.407eE-02  -1. 407o£— 02 
O.OOOOE+OO  3.  B2C2E-01 


I.249IE-02  -3.2491E-02 
-3.B202E-01  O.OOOOE+OO 
1.2751E+0©  -1.2751 E-00 
1.B398E+00  -1.8898E+00 


O.OOOOE+OO  O.OOOOE+OO  5.S033E-01  -5.S033E-01 
O.OOOOE+OO  1.2793E+00  -1.2795E+00  O.OOOOE+OO 


CLC-E3  LDDP  ZEROS 
(1  z  24) 


REAL  PART 

1.9711E+03  9.7852E+01  9.7852E+01  -1.9007S-02  -1.9161E-02  -2.0403E-02 
-2.0403E-02  -5.7143S-02  -1.0419S-01  -1.0619E-01  -1.2729E-01  -2.0323E-01 
-2.2075E-01  -3. 1904E+01  -3.1904E+01  -9.9733E+01  -9.9733E+01  -1.J079E+02 
-1.1073E+02  -1.799BE+03  -1.7998E+03  -1.2192E+04  -1.2192E+04  -B.&238E+04 


IHftSINARY  PART 

-9.91B7E+Q2  9.8791E+01  -9.B791E+01  O.OOOOE+OO  O.OOOOE+OO  1.4043E-02 
— 1 . 4043c— 02  O.OOOOE+OO  3.7490E-01  -3.7490E-01  O.OOOOE+OO  O.OCOOE+OO 
O.OOOOE+OO  2. 1984E+03  -2.1984E+03  9.B791E+01  -9.6791E+01  2.7447E+04 
-2.7447E+04  1.1325E+C3  -1.1325E+03  2.3498E+04  -2.3498E+04  O.OOOOE+OO 
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ORIGINAL  1ft TRICES  PRIOR  TO  SOtLlWfi 


3. 3243E-02  -2. HUE-02  -2.7720E-03 
1.1441E-03  -1.5919E— Ot  -1.9338E-03 
2. 422IE-Q5  4.A499E-04  -1.0431E-OI 
2.4414E-04  -i. 1A80E— 02  -1.3224E-03 
■S.3732E-04  -1.33SSE-05  1.3207E-03 
■2. 7344E-OS  -2.0277E-03  2.4043E-0S 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOQE+QQ  O.OQOOE+OQ 
I.2324E-01  -1.0728E-01  9.3454E-01 


A  HATRIX 

■1.8944E-02  -2.9343E-01  3.1474E+00 
■1.1444E+00  1.1274E-01  -1.5397E+01 
■1.3984E+00  I.2070E+01  8.0194E-O2 
■4.3445E-01  -2.3879E-01  -7.1773E-03 
■1.1380E-02  -4. 0733E-OI  1.0074E-04 
■9. 1034E— 03  3.4042E-03  -3.8180E-01 
l.OOOOE+OO  1.3427E-02  -1.2348E-01 
O.OOOOE+OO  9.9414E-01  1.0810E-01 
O.OOOOE+OO  -I.OW3E-91  1.0Q18E+00 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


O.OOOOE+OO  2. 9324E-04 

O.OOOOE+OO 

1.3004E-01  -1.7544E-03 

O.OOOOE+OO 

O.OOOOE+OO  7.3597E-03 

O.OOOOE+OO 

•1.3995E-OI  2.1403E-03 

O.OOOOE+OO 

O.OOOOE+OO  -2.4934E-93 

O.OOOOE+OO 

2.5834E-04  -3.4893E-04 

O.OOOOE+OO 

■2.0244E-10  -1.2440E-02 

O.OOOOE+OO 

1.2447E-02  O.OOOOE+OO 

O.OOOOE+OO 

1.S423E-09  1.3405E-03 

O.OOOOE+OO 

1.3702E+00  -4.3493E+01 

O.OOOOE+OO 

-1.4313E-03 

O.OOOOE+OO 

-1.4442E+00 

O.OOOOE+OO 

1.3872E-02 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 


8  HATH I I 

-3.8394E-02  2.3022E-03  2.3022E-03 
2.3U9E+00  -I.4950E-01  1.4930E-01 
-1.4813E-04  -9.8474E-01  -9.3474E-01 
4. 2384E-02  2.0848E-01  -2.0848E-01 
4.8842E-07  -2.3823E-02  -2.3823E-02 
-5. 3393E-02  -3.3474E-04  3.3474E-04 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 


O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 

O.OOOOE+OO 


O.OOOOE+OO  O.OOOOE+OO  Q.OOOQE+OO  O.OOOOE+OO 


APPENDIX  Cl 

STATE  SPACE  MATRICES  QF  THE  S20R1  LINEAR  MODEL. 


REDUCED  AND  SCALED  PLANT  HATKIC6S  WITH  APPROPRIATE  C  flflTHIX 


-5.3269E-02  -2.19646-02  -2.7533E-03  -3.3173E-04 
1.14176-03  -1.59396-01  -3.37866-05  -2.35786-02 
-4.7476E-04  1.39106-03  -9.45266-02  -2.7949E-02 
1.39456-02  -6.64306-01  -9.09316-02  -4.34526-01 
7. 14186-03  -2.59296-04  7.3117E-02  -1.14066-02 
-1.57826-03  -1.16226-01  3.40356-04  -8.00116-03 
0.00006+00  0.00006+00  0.00006+00  1.00006+00 
0.00006+00  0.00006+00  0.00006+00  0.00006+00 


A  HATE! I 

2.07346-03  5.53946-02  0.00006+00  5.1285E-06 
2.83536-03  -2.68606-01  2.27456-03  -2.59146-05 
2.11636-01  7.61406-04  0.00006+00  1.32216-04 
-2.52626-01  -2.19206-02  -1.6030E-01  1.8264E-03 
-4.08156-01  -7.73276-04  0.00006+00  -2.49856-03 
2.28096-03  -3.82016-01  2.58936-04  -2.95016-06 
1.13286-02  -1.05386-01  -4.93526-10  -1.26356-02 
9.9427E-01  1.06896-01  1.24946-02  0.00006+00 


8  HAT8II 

-1.26666-03  -1.52796-03  9.3425E-03  9.86256-05 
0.00006+00  6.04916-02  -3.69766-03  3.69766-03 
-2.52046-02  -3.8763E-08  -2.1483E-02  -2.1483E-02 
0.00006+00  6.3847E-02  2.60606-01  -2.60606-01 
1.38736-02  7.32566-07  -2.97816-02  -2.9781E-02 
0.00006+00  -8.78466-02  -4.20946-04  4.20946-04 
0.00006+00  0.00006+00  0.00006+00  0.00006+00 
0.00006+00  0.00006+00  0.00006+00  0.00006+00 
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C  MATRIX 


O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO 
1.0339E-01  -1.0629E-01 


O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO 
9.8873E-01  O.OOOOE+OO 


O.OOOOE+OO  O.OOOOE+OO 
O.OOOOE+OO  O.OOOOE+OO 
1.0749E-01  9.9984E-01 
O.OOOOE+OO  O.OOOOE+OO 


l.OOOOE-Ol  O.OOOOE+OO 
O.OOOOE+OO  l.OOOOE-Ol 
4.E827E-09  I.3314E-03 
2.7119E-02  -8.4843E-01 


APPENDIX  C 2 


MATRICES  2?  THE  30  KNOT  CCXPEXSATC3 

FILTER  SAIN  .MATRIX 

-1.0282E+00  -1.3198E+01  -3.1019E-01  -2.1480E+00 

1.1922E-01  7. 9327E-02  -7.5141E-01  2.3994E-02 

1 . ?03 IE-rOO  1.7444E+00  -3.4329E-01  1.3857E-01 

-1.4904E+00  4.2419E-01  1.2014E+00  1.1415E-01 

9.300SE-03  4.4870E-01  9.2493E-02  3.49BIE-02 

4.3777EHJ3  -3.4783E-01  -2.4334E-01  -3.3983E-02 

2.4814E-02  4.1892E+00  2.1197E-01  4.9849E-01 

1.8704E-01  2.4743E-01  -3.S220E-01  4.9200E-02 

-S.0473E-02  -4.2343E-03  -3.1907E-02  3.3337E-04 

-4.2073E-02  2.I331E-02  3.S310EHU  -4.2349E-03 

3.3431E+00  2.1792E-01  -3.3301EHJI  -1.5210E-01 

2. 1792E-0I  4. 98B7E+00  2.3426E-01  -4.3414EHJ3 

CONTROL  SAIN  .IflTRII 

1.3487E+00  1.4722E-33  -1.8457E-03  3.2330Eh)3  -2.3933E+00  2.1843E+00 

•2.3081E+01  4.4479E-42  2.3344E+01  2. 0238E+00  -2.3789E-01  2.5931E+01 

1.4722-03  2. 0983E+00  -I.1733E-02  -4.2471E-02  -4.7100E-02  2.5212E+00 

-7.4947E-01  1.9053E-01  1.7014E+00  -2.3194E+Qt  8.3982E-02  3.4430E-0I 

-1.3437E-03  -1.1733E-02  1.3132E+00  -3.5292E-01  -7.9313E-01  -1.3192E+00 

-8.4152E+00  2.5982E+00  -1.9349E+00  I.4394E+00  1.4934E+Q0  4.8934E+00 

3.2330E-03  -4.2471E-02  -3.3292E-01  1.2833E+00  -9.4103E-01  2.7412E+00 

-3.7112E+00  -2.3781E+00  -J.3331E-01  4.3044E-01  -1.9771E+00  5.4309E+0Q 
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L  MATRIX 


-a.0839E-0l  -3.4479E+QI  S.4433E-01  -4.3533E+00 
1.I410E-02  8. 71 14E-02  -1.52B4E+00  4.4870E-03 
3.3427E+00  3.3327E+00  -2.4333E+00  4.487IE-01 
-2.4340E+00  8.8502E-01  2.7345E+00  1.5323E-01 
-2.3SB2E-02  8.9419E-01  8.1347E-14  1.0339E-OI 
2.3824E-02  -9.0182E-01  -8.2242E-14  -1.0429E-01 
-2.4814E-0I  8.3S88E+00  7.4302E-13  9.3873E-01 
O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  0. OOOOE+OO 

4.9774E-09  1.4134E-03  -1.0429E-01  -4.4349E-13 

-4.4300E-08  -1.3144E-02  9.3873E-01  4.1272E-12 
1.0000E+01  -1.4491E-09  -3.3444E-17  1.2488E-U 
-1.3284E-10  l.OOOOE+Ol  4.921IE-12  -5.3841E-09 

OPEN  LOOP  EIS&HVftLtlSS 

9.3843E-09  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  -1.U74E-02  -3.8412E-02 
-4.4084E-01  -4.4084E-01  -4.3U4E-01  -S.0484E-01  -3.3943E-01  -S.8943E-01 

-4.0461E-02  -4.2884E-02  -7.1344E-02  -1.9489E-01  -I.9489E-OI  -2.5114E-01 
-9.314SE-01  -9.5148E-01  -1.0104E+00  -1.33B7E+00  -1.3887E+00  -1.4442E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

4.7901E-01  -4.7901E-01  O.OOOOE+OO  O.OOOOE+OO  I.1344E+00  -1.1344E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  3.1300E-01  -3.1300E-01  O.OOOOE+OO 

1.0148E+00  -1.0148E+00  O.OOOOE+OO  1.3184E+00  -1.3134E+00  O.OOOOE+OO 
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appemdix  C2 


MATRICES  OF  THE  20  KNOT  CCMPENSATOR 


OPEN  LOOP  TRANSMISSION  ZEROS 


1.0000E+30  1.0000E+30  1.0000E+30  I.OOOOE+30  1. 162IE-HJ8  1.0192E+08 

-3. 9747E-02  -3.9747E-02  -1.9849E-01  -2.04&9E-01  -2.0449E-01  -2.IQ97E-01 

1.2814E+Q3  1.4240E+C4  1.2133E+00  1.2202E+Q0  -1.4234E-02  -I.3414E-32 

-2.8337E-01  -4.S944E-01  -1.4243E+04  -1.2SI4E+0S  -3.4484E+07  -5.303BE+09 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

1.4540E-03  -1.A540E-03  O.OOOOE+OO  2.8343E-01  -2.3343E-01  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  1.0821E+04  -1.0831E+04  O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 

.  CLOSED  LOOP  El SEMV ALOES 


-1.4220E-O2  -3.3414E-02  -3.8479E-02  -4.1399E-02  -I.0317E-Ot  -1.03I7E-0I 

-5.1044E-01  -S.1044E-01  -3.1314E-01  -S.2333E-0I  -3.2333E-01  -7.I313E-01 

-2.3970E-01  -2.3970E— 01  -2.5104E-01  -2.7292E-01  -2.7292E-0I  -4. 1228E-01 

•7. 4333E-01  -7.3232E-01  -7.2232E-01  -I.0388E+00  -1.1937E+OQ  -1.1937E+00 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  1.0439E-O1  -1.0459E-01 

7.0401E-02  -7.0401E-02  O.OOOOE+OO  9.2144E-01  -9.2144E-0I  O.OOOOE+OO 

3.3449E-01  -3.3449E-01  O.OOOOE+OO  2.7737E-01  -2.7737E-01  O.OOOOE+OO 

O.OOOOE+OO  8.3933E-01  -8.3933E-01  O.OOOOE+OO  I.1439E+00  -1.I439E+00 


CLOSED  LOOP  TRANSMISSION  ZEROS 


7.3203E+10  1.1320E+04  3.4830E+03  4.7422E+03  2.S300E+02  2.3300E+02 

-3.9748E-02  -3.9748E-02  -1.9849E-01  -2.0449E-01  -2.0449E-O1  -2.S097E-OI 

1.3900E+00  1.4499E+00  2.3444E-01  7.3307E-OI  -1.42I3E-02  -3.84I4E-02 

-2.3337E-01  -4.3944E-01  -5.0498E+02  -4.7412E+03  -8.4823E+03  -1.1349E+04 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  4.3878E+02  -4.3878E+02 

1.4327E-03  -1.4327E-03  O.OOOOE+OO  2.3343E-01  -2.3343E-01  O.OOOOE+OO 

2. 4470E+03  -2.4470E+05  1.3430E+04  -I.S430E+04  O.OOOOE+OO  O.OOOOE+OO 

O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO  O.OOOOE+OO 
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